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Umfassende Kenntnisse der theo¬ 
retischen Grundlagen und derzur 
Verfügung stehenden Gerätetech¬ 
nik moderner Steuerungssysteme 
sind das unbedingte Rüstzeug für 
jeden, der sich mit dem Entwurf 
und Einsatz moderner Steuerun¬ 
gen für Industrieroboter beschäf¬ 
tigen will. Der Vermittlung von 
Kenntnissen auf dem für so viele 
Industriezweige wichtigen Gebiet 
dient dieses Buch. 

Nach einer kurzen Einführung wer¬ 
den die Grundprinzipien der 
Steuerung von Industrierobotern 
dargestellt, dabei wird eine Struk¬ 
turierung des Steuerungssystems 
vorgenommen und eine Übersicht 
über die Funktion der einzelnen 
Teilgebiete gegeben. Besonderer 
Wert wird dann auf die Behand¬ 
lung der Modelle der kinemati¬ 
schen Systeme, der Antriebe und 
Meßsysteme gelegt. Danach wird 
die Bewegungssteuerung mit 
ihren beiden Komponenten der 
Bahnsteuerung und der Servore- 
jgelung besprochen. Es folgt eine 
'systematische Darstellung des 
'Entwurfs binärer Ablaufsteuerun- 
gf^n. Bei der Behandlung der Pro¬ 
grammierung von Industrierobo¬ 
tern wird der textuellen Pro¬ 
grammierung und den höheren 
Programmiersprachen besondere 


I Aufmerksamkeit gewidmet. Der 
Sensortechnik und den visuellen 
Erkennungssystemen für Indu- 
j strieroboter der 2. und 3. Genera- 
! tion ist ein gesonderter Abschnitt 
I gewidmet. Zum Aschluß werden 
die beiden in der DDR verfügba- 
' ren Industrierobotersteuerungs- 
1 Systeme vorgestellt. DieAusfüh- 
rungsbeispiele sind für die Praxis 
von besonderem Interesse. 

Das Werk ist für alle diejenigen 
von Nutzen, die auf dem Gebiet 
j des Entwurfs und des Einsatzes 
I von Industrierobotersteuerungen 
I tätig sind. 
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Vorwort 


Industrieroboter gelten heute als Symbol fortgeschrittener Technologie. Produktion und 
Einsatz dieser Automatisierungsmittel haben im letzten Jahrzehnt eine stürmische Ent¬ 
wicklung genommen, wobei ihre potentiellen Einsatzmöglichkeiten bei weitem nicht er¬ 
schöpft sind. Die Grundeigenschaften, die den Einsatz von Industrierobotern in den ver¬ 
schiedensten Industriezweigen ermöglichen, sind ihre universelle Beweglichkeit und die 
freie Programmierbarkeit. Während die Bewegungsmöglichkeiten durch den Maschinen¬ 
bauer zu gewährleisten sind, ist die Realisierung der Programmierbarkeit und die pro¬ 
grammgesteuerte Ausführung von Bewegungen eine steuerungstechnische Aufgabe. 
Industrieroboter sind vorwiegend elektronisch gesteuerte Maschinen. 

Dieses Buch soll eine Einführung und Übersicht über die Steuerungstechnik von 
Industrierobotern geben. Es wendet sich damit sowohl an Ingenieure, die mit der Ent¬ 
wicklung und dem Bau von Industrierobotern beschäftigt sind, als auch an den Anwen¬ 
der, der mehr über die innere Funktionsweise und das Zusammenspiel der Baugruppen 
des Steuerungssystems erfahren möchte. 

Behandelt werden sowohl klassische Wissenszweige der Regelungs- und Steuerungs¬ 
technik, die für die Steuerung von Industrierobotern Bedeutung haben, als auch neuere 
Gebiete, die sich insbesondere unter dem Einfluß der Robotertechnik entwickelt haben. 
Dies betrifft vor allem die Sensortechnik und Sensorsignalverarbeitung und die Pro¬ 
grammiersysteme für Industrieroboter. Moderne elektronische Robotersteuerungen ar¬ 
beiten auf Mikrorechnerbasis. Deshalb wird besonderes Augenmerk auf die Darstellung 
von Steuerungs- und Verarbeitungsalgorithmen und ihre Realisierung mit den geräte- und 
programmtechnischen Mitteln der Mikrorechentechnik gelegt. Ein gesonderter Abschnitt 
ist der Programmierung von Industrierobotern gewidmet. Hier wird dargestellt, wie durch 
eine geeignete Softwaregestaltung die erforderliche Einsatzflexibilität erreicht werden 
kann. Bei der Anlage des Buches wurde unter Berücksichtigung des angesprochenen Leser¬ 
kreises der Übersichtsdarstellung gegenüber einer ausführlichen Detailbehandlung der 
Vorzug eingeräumt. Die Gedankenlinie verläuft dabei von der Darstellung allgemeiner 
Grundlagen über die aus der Modellbildung der zu steuernden Komponenten des Indu¬ 
strieroboters abgeleiteten Verarbeitungsalgorithmen bis zur Beschreibung industrieller 
Robotersteuerungen. 

Abschließend sei dem Verlag Technik für die großzügige Unterstützung und dem 
Lektor, Herrn Reichenbäch, für die vertrauensvolle Zusammenarbeit herzlich gedankt. 


Die Herausgeber 
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1 . 


Einführung 


Industrieroboter werden etwa seit Ende der sechziger Jahre industriell hergestellt und als 
universelle Automatisierungsmittel eingesetzt. Sie stellen eine wesentliche Voraussetzung 
für eine bedienerarme und flexible Gestaltung und Durchführung des Produktions¬ 
prozesses dar. Während der konventionelle Produktionsprozeß mit prozeßspezifischen 
Automatisierungsmitteln ausgerüstet ist, wird der Fortschritt, der durch die Industrie¬ 
robotertechnik eintritt, durch zwei wesentliche Prinzipien getragen: 

- den Einsatz von universell beweglichen Geräten, die zur Handhabung von Werkstücken 
und Werkzeugen und zur Durchführung technologischer Prozeßschritte eingesetzt 
werden können und in Serienproduktion rationell herstellbar sind; 

- die Ausrüstung dieser Geräte mit einer programmierbaren Steuerung, die die erforder¬ 
lichen Operationen automatisch auszuführen gestattet. 

Die beiden Grundeigenschaften der leichten Anpaßbarkeit an unterschiedliche techno¬ 
logische Arbeitsplätze und der Programmierbarkeit der verschiedenen Operationsfolgen 
machen nicht nur den einzelnen Industrieroboter flexibel einsetzbar, sondern übertragen 
diese Flexibilität auch auf die roboterbestückte Fertigungszelle oder Fertigungslinie. 

Industrieroboter konnten erst rationell gefertigt und effektiv eingesetzt werden, als es 
gelang, sie mit kompakten Steuerungssystemen auszurüsten, die die zweite der genannten 
Grundeigenschaften ausreichend gewährleisteten. Deshalb bildete die Mikroelektronik 
mit ihren rasch anwachsenden Verarbeitungsmöglichkeiten eine notwendige Voraus¬ 
setzung für die Erfolge der Industrierobotertechnik, und es ist kein Zufall, daß der starke 
Aufwärtstrend der Industrieroboter nahezu zeitsynchron mit der Entwicklung und Ver¬ 
vollkommnung der Mikroprozessoren und Mikrorechner verläuft. 

Einerseits ist der Industrieroboter für die Steuerungstechnik nicht in allen seinen Ver¬ 
haltenseigenschaften ein völlig neues Steuerungsobjekt. Auf viele Erfahrungen aus der 
Steuerung von Werkzeugmaschinen konnte und kann bei der Entwicklung von Roboter¬ 
steuerungen zurückgegriffen werden. Andererseits sind durch die speziellen Achsanord¬ 
nungen, die relativ hohen Verfahrgeschwindigkeiten, die enge Kommunikation mit dem 
technologischen Prozeß und die besonderen Anforderungen an die Programmierung und 
Bedienung neue Prinzipien entwickelt und erforscht worden, die der Robotersteuerungs¬ 
technik ihr besonderes Gepräge geben. Diese Technik soll in diesem Buch zusammen¬ 
gefaßt dargestellt werden. 

Im Abschnitt 2. werden die Grundprinzipien der Steuerung von Industrierobotern be¬ 
handelt. Ausgehend von den Steuerungsaufgaben wird eine Strukturierung des Steue¬ 
rungssystems vorgenommen und eine Übersicht über die Funktion der einzelnen Teil¬ 
systeme gegeben. 

Abschnitt 3. behandelt Funktionseinheiten von Industrierobotern, soweit und wie sie 
für die Steuerungstechnik relevant sind. Das bezieht sich besonders auf die Antriebe und 
Meßsysteme, die direkt mit der Steuerung kommunizieren, aber auch auf das kinemati¬ 
sche System, dessen Auslegung und Eigenschaften bei der Gestaltung der Bewegungs¬ 
steuerung zu berücksichtigen sind. Die Bewegungssteuerung selbst wird in ihren beiden 
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Komponenten, der Bahnsteuerung und der Servoregelung, im Abschnitt 4. besprochen. 
Nach der Vorstellung der Grundprobleme erfolgt die Modellbildung für das kinematische 
System einschließlich der Antriebe und die Behandlung ausgewählter Regelungsverfahren. 
Der zweite Teil dieses Abschnitts ist dann der Bahnsteuerung zur Erzeugung der Soll¬ 
wertverläufe für das Servoregelungssystem Vorbehalten. 

Abschnitt 5. enthält eine systematische Darstellung der binären Steuerungsaufgaben 
für einen Industrieroboter und deren Lösung. Beschrieben werden hier Methoden zur 
Ablaufplanung und zur Implementierung von Ablaufsteuerungen mit Mikrorechnern. 
Die Programmierung von Industrierobotern wird im Abschnitt 6. behandelt. Hier geht es 
sowohl um die Darstellung der einzelnen Programmierverfahren als auch um technische 
Realisierungsmethoden. Der textuellen Programmierung und den höheren Programmier¬ 
sprachen wird dabei besondere Aufmerksamkeit gewidmet. Die Verarbeitung von Sensor¬ 
daten in Robotersteuerungen ist Gegenstand von Abschnitt 7. Hier werden die grund¬ 
sätzlichen Verarbeitungsschritte erläutert, die Ableitung von Steuerungsinformationen 
aus Sensordaten dargestellt und ausgewählte Beispiele besprochen. 

Abschnitt 8. gibt einen zusammenfassenden Überblick über die gegenwärtig in der 
DDR verfügbare industrielle Realisierungsbasis für Industrierobotersteuerungen. Be¬ 
handelt werden sowohl modulare Gerätesysteme, mit denen Steuerungen projektiert 
werden können, als auch Ausführungsbeispiele serienmäßiger Robotersteuerungen. 



2 . 


Grundprinzipien der Steuerung von Industrierobotern 


2.1. Industrieroboter 

Industrieroboter (IR) sind universell einsetzbare technologische Automatisierungsmittel, 
die durch folgende Merkmale gekennzeichnet sind: 

- IR sind automatische Handhabungseinrichtungen für den industriellen Einsatz. 

- Sie sind in mehreren Freiheitsgraden (Bewegungsachsen) im Raum beweglich. 

- Die Operationen eines IR sind freiprogrammierbar. 

Die Industrieroboter müssen von den Manipulatoren unterschieden werden. Mani¬ 
pulatoren sind Handhabungseinrichtungen, die mit Hilfe von Greifern und Greifer¬ 
führungsgetrieben Hand und Arm des Menschen nachbilden und zum Bewegen von 
Gegenständen im Raum geeignet sind. Erfolgt die Steuerung unmittelbar per Hand, so 
spricht man von einem Synchronmanipulator oder Balancer.^ 

Die automatische Arbeitsweise von Industrierobotern schafft die Voraussetzung für 
den Ersatz menschlicher Arbeitskräfte an den unterschiedlichsten Arbeitsplätzen. Die 
universelle Beweglichkeit gewährleistet dabei eine weitgehend beliebige Positionierung 
und Orientierung des am Roboterhandpunkt angebrachten Greifers oder Werkzeugs und 
ist damit eine notwendige Voraussetzung für die Erfüllung von Handhabe- und techno¬ 
logischen Aufgaben. 

Die von einem Industrieroboter auszuführenden Operationen lassen sich in Bewegun¬ 
gen und Aktionen einteilen. Bewegungen werden durch gesteuertes Verfahren der Achsen 
unter Berücksichtigung numerischer Vorgaben (Positionen, Geschwindigkeiten) erzeugt. 
Aktionen sind vorwiegend binäre Operationen, die Schaltvorgänge am Handpunkt (z. B. 
Greifer öffnen, Farbstrahl freigeben) oder in der IR-Peripherie (z.B. Rundtisch weiter¬ 
schalten) auslösen. 

Freie Programmierbarkeit bedeutet schließlich, daß der Bediener/Programmierer zu 
beliebigen Zeitpunkten über eigens dafür vorgesehene Funktionselemente (Bedienfeld, 
Programmierhilfsgerät) eine beliebige Folge von Operations-(Bewegungs- und Aktions-) 
Befehlen eingeben und bei Bedarf ändern kann. Das Gegenstück dazu sind festprogram¬ 
mierte Systeme, bei denen in der Inbetriebnahmephase das Programm erstellt und ein¬ 
gefahren wird und später nur durch gerätetechnische Eingriffe in das System (z.B. Aus¬ 
tausch des Programmspeichers, mechanische Veränderung von Schaltnocken) geändert 
werden kann. 

Der Einsatz eines oder mehrerer Industrieroboter ist eine technologische Aufgabe, die 
sich in die Teilprobleme 

- Gestaltung des Roboterarbeitsplatzes und der Peripherie des Industrieroboters (unter 
letzterem wird die Gesamtheit aller technologischen Hilfseinrichtungen, z.B. Spann¬ 
vorrichtungen, Ablagen, Paletten und Schutzvorrichtungen, verstanden, die der IR zur 
Erfüllung seiner technologischen Aufgabe benötigt); 

- Auswahl bzw. Entwicklung des Grundgeräts (darunter wird der maschinenbautechni- 
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sehe Teil des IR einschließlich der Antriebe, der Meßwertaufnehmer und der Stell¬ 
glieder verstanden); 

- Auswahl bzw. Entwicklung der IR-Steuerung. 

Aufgrund ihrer engen Wechselbeziehungen können diese drei Teilaufgaben nur ge¬ 
meinsam im engen Zusammenwirken von Technologen, Maschinenbauern und Steue¬ 
rungstechnikern erfolgreich gelöst werden. Einige dieser Wechselbeziehungen, die ins¬ 
besondere den Steuerungstechniker interessieren, sind im Bild 2.1 angegeben. Zunächst 
stellen aufgrund der technologischen Aufgabe das Grundgerät und die Peripherie An¬ 
forderungen an die Steuerung, die insbesondere 

- die Art der Bewegungssteuerung, 

- die Anzahl der zu steuernden Achsen und der binären Steuersignale, 

- die Kommunikation mit anderen an der Lösung der technologischen Aufgabe be¬ 
teiligten Einrichtungen (z. B. Bearbeitungsmaschinen und Fördereinrichtungen), 

- die Überwachung und Gewährleistung der Prozeßsicherheit 

betreffen. 



Bild 2.1 

Teilprobleme bei einem Industrie¬ 
robotereinsatz 


Außerdem werden an die zu steuernden Objekte Steuerbarkeitsforderungen gestellt. 
Sie beziehen sich u. a. auf 

- die Auslegung des Grundgeräts (z. B. Spielfreiheit des Signalwegs Antrieb-Meßsysteme, 

- die Festlegung des Charakters und der Art der auszutauschenden Steuersignale (z. B. 
Signalpegel, parallele oder serielle Übertragung), 

- Schutzmaßnahmen gegen Störeinflüsse (z. B. galvanische Trennung von Steuerung und 
Steuerungsobjekt). 

Schließlich ergeben sich bei der Lösung der technologischen Aufgabe aus steuerungs¬ 
technischer Sicht häufig neue funktionelle Möglichkeiten, die über die ursprüngliche Auf¬ 
gabenstellung hinausgehen. Sie beziehen sich vorwiegend auf die Erhöhung von Qualität 
und Quantität der steuerungsinternen Verarbeitungsleistung und bewirken eine ver¬ 
besserte Prozeßanpassung und bessere Eigenschaften oder erweiterte Möglichkeiten der 
Bedienung und Programmierung des Roboters. 

Bezüglich des Einsatzes lassen sich drei Klassen von IR unterscheiden (Bild 2.2): 

Die Beschickungsroboter führen technologische Hilfsoperationen (vorwiegend Be¬ 
schicken von Werkzeugmaschinen, aber auch andere Transportoperationen) aus. Sie sind 
dazu mit einem Greifer ausgerüstet, kommunizieren relativ stark mit der den techno¬ 
logischen Prozeß ausführenden Einrichtung und werden mitunter auch von der dieser 
Einrichtung (Werkzeugmaschine) zugeordneten Steuerung mit gesteuert. Als Bewegungs- 



Rpreitsteilung funk tion^ 

Möglichkeiten 
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verhalten ist das sequentielle Anfahren diskreter Raumpunkte ohne funktionellen Zu¬ 
sammenhang der Achsbewegung (PTP Punkt-zu-Punkt-Steuerung) typisch. In einfachen 
Fällen, in denen mit festen Anschlägen gearbeitet werden kann, genügt eine binäre Ab¬ 
laufsteuerung ; bei einer größeren Anzahl anzufahrender Raumpositionen werden Lager¬ 
regelkreise mit analog oder digital vorgebbaren Sollwerten eingesetzt. Im letzteren Fall 
spricht man auch von numerisch gesteuerten Achsen. 

Der technologische Roboter (Bild 2.3) führt technologische Hauptoperationen, wie 
Schweißen, Farbspritzen, Schleifen und Entgraten, selbständig aus. Er trägt am Hand- 


technotogischer 

Prozeß 



Handhabegerät 


Werk¬ 

stück 


—Csl 



Werkzeug¬ 

maschine 


Magazin 


maschinenbau¬ 
technischer Teil 
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Steuerung 
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Bedien- und 
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a) 
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Programmier- 
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Bild 2.2 

Einsatzklassen von Industrie¬ 
robotern 

a) Handhabegerät (nach [2.2]) 

b) technologischer Roboter 

c) Montageroboter 
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punkt entweder ein Werkzeug (z. B. Schweißpistole, Schleifmaschine) oder einen Greifer, 
mit dem er das Werkstück an die Arbeitsmaschinen heranführt und bearbeitet. Er ver¬ 
fügt über eine Steuerung, die das Programmieren und Reproduzieren von Bewegungs¬ 
bahnen in mehreren Achsen gestattet (Bahnsteuerung). Die Antriebe sind dazu fast immer 
lagegeregelt. Eine Ausnahme stellen IR zum Punktschweißen dar, die mit einer Punkt-zu- 
Punkt-Steuerung auskommen. 




Bild 2.4 

Montageroboter 

(mit freundlicher Genehmigung der Fa. 
Stiefelmayer) 
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Der Montageroboter (Bild 2.4) führt automatisch Montageoperationen aus. Er ist dazu 
mit einem Montagegreifer (Fügekopf) ausgerüstet. Die Steuerung gewährleistet in der 
Regel sowohl Punkt-zu-Punkt- als auch Bahnbewegungen und muß diese Bewegungen 
auch unter Berücksichtigung von Zusatzbedingungen (z.B. begrenzte Fügekraft) aus¬ 
führen. Montageroboter kommunizieren sehr stark mit der technologischen Umwelt und 
sind gewöhnlich mit einem umfangreichen System von Sensoren ausgerüstet. 

Die Unterscheidung dieser drei Einsatzklassen bedeutet nicht, daß alle Industrie¬ 
roboter jeweils auf eine dieser Klassen zugeschnitten sind. So gibt es einerseits sehr viele 
Geräte, die ausschließlich in der Werkstückhandhabung eingesetzt werden können; 
andererseits gestatten universellere Industrieroboter einen Einsatz sowohl in der Hand¬ 
habung wie auch als technologische Roboter oder sogar in allen drei der genannten Ein¬ 
satzklassen. Ob für einen bestimmten Einsatzfall ein universelles oder ein entsprechend 
zugeschnittenes Gerät auszuwählen ist, wird vorwiegend durch ökonomische und produk¬ 
tionsorganisatorische Bedingungen bestimmt. 


2.2. Grundfunktionen einer Industrierobotersteuerung 


Wesentliche Robotereigenschaften, wie Programmierbarkeit, Anpassungsfähigkeit und 
Einsatzflexibilität, werden durch die Steuerung gewährleistet oder entscheidend beein¬ 
flußt. Im wesentlichen erfüllt eine IR-Steuerung folgende Aufgaben, die insgesamt auch 
die Steuerungsstruktur prägen: 


- Realisierung des Gesamtablaufs entsprechend 
sorgt eine Funktionsgruppe Ablaufsteuerung; 


dem eingegebenen Programm, dafür 



Bild 2.5 

Schnittstellen und zugeordnete Funktions¬ 
gruppen einer IR-Steuerung 


- Gewährleistung der Programmierbarkeit des Industrieroboters, dafür ist eine Funk¬ 
tionsgruppe Programmiersystem vorgesehen, die die Ein- und Ausgabe, den Test und 
die Änderung von Roboterprogrammen ermöglicht; 

- Steuerung, Koordinierung und Überwachung der Bewegungen des Grundgeräts, dafür 
ist die Funktionsgruppe Bewegungssteuerung zuständig; 


2 Industrierobotersteuerung 
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2. Grundprinzipien der Steuerung von Industrierobotern 


- Kommunikation mit der technologischen Umwelt zur Koordinierung von Aktions¬ 
und Bewegungsabläufen und Synchronisation mit dem technologischen Prozeß, sie 
erfolgt in der Funktionsgruppe Aktionssteuerung (gelegentlich auch als Technologie¬ 
steuerung bezeichnet); 

- Kommunikation mit dem Bediener/Programmierer und dem Wartungs- bzw. Instand¬ 
haltungspersonal, sie wird über eine Dialogsteuerung abgewickelt; 

- Kommunikation mit anderen (IR- oder Werkzeugmaschinen-) Steuerungen oder mit 
einem Leitrechner, dafür ist die Funktionsgruppe Datenaustauschsteuerung vorgesehen. 

Bild 2.5 gibt eine Übersicht über die Schnittstellen einer IR-Steuerung und die jeweils 
angeschlossenen Funktionsgruppen. Je nach Einsatzfall und dadurch bedingten Aus¬ 
rüstungsgrad der Steuerung können einzelne Funktionsgruppen mehr oder weniger stark 
ausgebaut sein oder auch ganz fehlen. So besteht beispielsweise für ein einfaches Hand¬ 
habungsgerät mit numerisch gesteuerten Achsen die Bewegungssteuerung einfach in der 
sequentiellen Aufschaltung des jeweils programmierten Positionssollwerts auf die Lager¬ 
regelkreise und einer Rückmeldung nach Erreichen dieser Position, während bei einem 
Montageroboter die Aktionssteuerung bzw. die Prozeßanpassung (Bild 2.5) durch ein um¬ 
fangreiches System zur Bildauswertung ergänzt werden kann. Das Programmiersystem 
ist um so umfangreicher, je komfortabler die Möglichkeiten der Programmerstellung und 
des Programmtests bei einem Industrieroboter sind. Es ist in elementarer Form bei teach- 
in-prögrammierbaren Robotern (s. 6.2.2.) und in weit ausgebauter Form beim Einsatz 
von problemorientierten Robotersprachen vorhanden. 

Manuell programmierte Handhabungsgeräte benötigen kein Programmiersystem. Hier 
übernimmt der Mensch durch manuelle Operationen vollständig die Programmerstellung 
und -änderung. 


2.3. Künstliche Intelligenz in Industrierobotersteuerungen 

Begriffe wie „künstliche Intelligenz“ oder „intelligente Geräte“ werden immer häufiger 
als Kennzeichen für ein hohes qualitatives Niveau der automatischen Lösung von Pro¬ 
blemen und einen großen Umfang an installierter Verarbeitungsleistung benutzt. Eine 
allen Ansprüchen gerecht werdende Definition der künstlichen (in Abgrenzung zur 
menschlichen) Intelligenz ist bisher noch nicht gelungen. Hier sollen einige Aspekte dieser 
Problematik kurz dargestellt werden, die mit dem Ersatz menschlicher Arbeitsleistung 
durch Maschinenleistung im Zusammenhang stehen und von Bedeutung für die Realisie¬ 
rung von Robotersteuerungen sind. Bei der Lösung einer technologischen Aufgabe wer¬ 
den im Prinzip immer drei hierarchisch aufeinander aufbauende Operationsstufen durch¬ 
laufen (Bild 2.6) [2.12]. 

Ausgehend von der allgemeinen Zielstellung wird zunächst ein Lösungskonzept er¬ 
arbeitet und daraus eine Planung der Lösung in Form von Teilproblemen abgeleitet 
(strategisches Niveau). Anschließend erfolgt eine Algorithmierung der Teilprobleme in 
Form der Festlegung von Folgen aus komplexen Operationen (taktisches Niveau). 
Schließlich werden auf operativem Niveau die komplexen Operationen in Elementar¬ 
operationen aufgelöst. 

Die künstliche Intelligenz oder, hier synonym, das Niveau der Verarbeitungsleistung 
eines Industrieroboters kann nun danach bewertet werden, welche der vorgenannten Auf¬ 
gaben durch die Robotersteuerung übernommen werden und welche folglich noch durch 
den Bediener/Programmierer gelöst werden müssen. Bei einem direktgesteuerten Mani- 
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pulator liegen alle drei Verarbeitungsniveaus beim Bediener, der das Gerät über Stell- 
und Schaltsignale steuert. Ein programmierbarer Industrieroboter kann Folgen von Be- 
wegungs- und Aktionsbefehlen ausführen, wobei die konzeptive Planung und Algorith- 
mierung der Problemlösung dem Bediener überlassen sind. Ein auf taktischem Niveau 
arbeitendes Steuerungssystem kann komplexe Instruktionen verarbeiten, während ein 
implementiertes strategisches Programmiersystem eine globale Programmierung durch 
Zielvorgaben gestattet. Die algorithmische Auflösung in Teilschritte wird dann durch 
die Steuerung selbst vorgenommen. Im Bild 2.6 rechts sind dazu Beispiele für Anweisun¬ 
gen auf jedem Niveau in umgangssprachlicher Notierung angegeben. Kleingeschrieben 
und unterstrichen sind dabei Anweisungen; großgeschrieben sind vereinbarte Variable 
oder Parameter. 


Generation - Niveau 



Operationsart ■■ 

Beispiel- 

zielgerichtete 

montiere 

(bewertete) 

LA5ERSCHALE 

Operationen 

gufOEHKUSE 


komplexe 

hole TEIL von 


Operationen 

PALETTE 




Bild 2.6 

elementare 

gehe nach (XXZ) 

Hierarchie von Ver¬ 

Operationen 

greif er auf 

arbeitungsniveaus 


Mit steigendem Verarbeitungsniveau bedarf die Steuerung immer umfassenderer In¬ 
formationen über die technologische Umwelt des Industrieroboters. Die Gesamtheit aller 
in der Steuerung vorhandenen Informationen dieser Art wird als Umweltmodell be¬ 
zeichnet. Im einfachsten Fall (operatives Niveau) wird die Umwelt bei der Auslegung der 
Steuerung und bei der Programmierung durch den Menschen fest installiert. Roboter mit 
taktischem Verarbeitungsniveau bedürfen bereits ständiger Informationen über den 
aktuellen Zustand der Umwelt. Letzterer wird durch Steuersignale erfaßt. Strategische 
Operationen erfordern ein komplexes Umweltmodell und eine Bewertung im Sinne der 
vorgegebenen Zielstellung. So sind die besprochenen Verarbeitungsniveaus gleichzeitig 
für die Einteilung von Industrierobotern nach Generationen charakteristisch (Bild 2.6 
links). Tafel 2.1 gibt eine Übersicht über die gegeiiwärtig definierten drei Roboter¬ 
generationen mit ihren wesentlichen Merkmalen. 

Im Unterschied zu der bekannten Einteilung von Digitalrechnern in Generationen, die 
sich durch ihre Realisierungsbasis (Integrationsgrad und Art der eingesetzten Bau¬ 
elemente) unterscheiden, erfolgt die Klassifizierung der Robotergenerationen nach ihrem 
Funktionsinhalt. Dabei nimmt die Leistungsfähigkeit mit steigender Generation zu. 
Damit ist der Begriff „Generationen“ nicht als zeitliche Aufeinanderfolge von Geräte¬ 
systemen aufzufassen, die einander ablösen, sondern im Sinne einer sich ständig er¬ 
weiternden Breite des IR-Einsatzfelds. Für Anwendungsfälle, bei denen der Funktions¬ 
inhalt eines Roboters der ersten Generation bereits hinreicht, ist somit auch ein Gene¬ 
rationswechsel im obigen Sinne nicht zu erwarten und nicht notwendig. 
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Tafel 2.1. Generationen von Industrierobotern 



Mensch-Maschine-Interface 

(Programmierung) 

Interface zum technolo¬ 
gischen Prozeß 

Realisierung, 
typische Baugruppen 

1. Generation 
programmierbare IR 

1 

manuelle Programmierung 
(Steckerfeld, Verkabelung, 
PROM) 

Teach-in (direkt und indirekt) 

Aktions- und Programm¬ 
ablaufbefehle in maschinen¬ 
orientierter Programmier¬ 
sprache 

einfache Kontroll- und Über¬ 
wachungselemente mit 
binärem Ausgang 

binäre Signale zur Koordinie¬ 
rung von Synchronisation 
von Bewegungen und 

Aktionen 

Reaktion auf Umweltäituatio- 
nen durch bedingte Befehle 
oder durch Stillsetzen des IR 

Steuerung vorwiegend auto¬ 
nom arbeitende oder in der 
Steuerung der zu bedienenden 
Einheit integrierte Systeme 

konventionelle Elektronik 

Mikrorechnerbaugruppen 
als Alternative zu Hardware¬ 
lösungen 

2. Generation 
sensitive IR 

erweiterte Teach-in-Verfah¬ 
ren (automatische Suche der 
Bewegungsbahn, Servounter- 

stützung) 

systemorientierte algorith¬ 
mische Programiersprachen 
(ablauforientierte Program¬ 
mierung) 

Sensorsysteme zur Erfassung 
technologischer Teilsituatio¬ 
nen 

binäre und analoge vekto¬ 
rielle Signale zur Reaktion auf 
Umweltveränderungen 

Reaktion durch spezielle 
Unterprogramme 
(ausgebautes Interruptsystem) 

Realisierung auf der Basis 
von Minirechnern oder 
Mikrorechnersystemen 

komplexe, auch mehrdimen¬ 
sionale Sensorsysteme 

Steuerungen untereinander 
und mit einer Zentral¬ 
steuerung kopplungsfähig 

weitgehend modularer Auf¬ 
bau 

3. Generation 
intelligente IR 

problemorientierte Program¬ 
miersprachen mit der Mög¬ 
lichkeit der Einbeziehung von 
Teach-in-Programmelementen 

globale (zielorientierte) 
Programmierung mit kom¬ 
plexem Umweltmodell 

intelligente Sensorsysteme 
zur komplexen Erfassung der 
technologischen Umwelt 

autonome Entscheidungs¬ 
findung und selbständige 
Planung von Teilabläufen 

Rechnerverbundsysteme 

komplexe, mehrdimensionale 
Sensoren mit umfangreicher 
Signalvorverarbeitung 

Integrationsfähigkeit in 
CAM-Systeme 

prinzipiell modularer Aufbau 


2.4. Grundstruktur einer Industrierobotersteuerung 

Die aus den Grundaufgaben abgeleiteten Funktionsgruppen (s. Abschn. 1.2.) werden 
hierarchisch in unterschiedliche Steuerebenen eingeordnet (Bild 2.7) [2.1]. 

Der IR-Steuerung übergeordnet kann eine Zentralsteuerung (Leitrechner) sein. Sie ist 
immer dann erforderlich, wenn mehrere Industrieroboter Zusammenarbeiten und ihre 
Bewegungen und Aktionen koordiniert werden müssen, und stellt in der Regel eine eigen¬ 
ständige Einheit mit einem zentralen Terminal dar, von dem aus eine komplette Ferti¬ 
gungszelle überwacht und gesteuert wird. Der Leitrechner kommuniziert über Daten¬ 
schnittstellen mit den einzelnen Robotersteuerungen der Zelle und gibt insbesonders vor, 
welches Programm wann abzuarbeiten ist. 
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Die anderen im Bild 2.7 dargestellten Steuerebenen sind in die eigentliche IR-Steue- 
rung integriert. 

Die Ablaufsteuerung sorgt für die Abarbeitung des Roboterprogramms. Bei Bewe- 
gungs- und Aktionsbefehlen aktiviert sie die Funktionssteuerung, in der die Bewegungs¬ 
und Aktionssteuerung zusammengefaßt sind. Die letzte Stellebene, die Effektorsteuerung, 



Bild 2.7 

Hierarchische Struktur einer 
Robotersteuerung (nach [2.1]) 


besteht im wesentlichen aus den Leistungsverstärkern für die Antriebe und andere Stell- 
und Schaltglieder, die auf Grundgerät und Peripherie einwirken. Wesentlich für die ein¬ 
wandfreie Funktion des Steuerungssystems sind Rückmeldungen vom Grundgerät oder 
von der Peripherie. Davon sind im Bild 2.7 die wichtigsten eingezeichnet, die entweder 
auf die Funktionssteuerung (z.B. Positions-Istwerte, Fertigmeldungen) oder in die Ab¬ 
laufsteuerung (Signale, die Bedingungen für den Programmablauf darstellen) zurück¬ 
wirken. Funktions- und Ablaufsteuerung sollen nachfolgend genauer behandelt werden. 


2.4.1. Funktionssteuerung 

Die Funktionssteuerung ist der Ablaufsteuerung hierarchisch untergeordnet und enthält 
prinzipiell zwei Wirkungslinien: 

Die Bewegungssteuerung (Bild 2.8 links) wertet die Bewegungsbefehle des Roboter¬ 
programms aus und steuert in Abhängigkeit davon die Antriebe der einzelnen Achsen an. 
Bei einfachen Handhabegeräten mit Punkt-zu-Punkt-Steuerung schaltet sie in Abhängig- 
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keit von dem vorgegebenen Endpunkt und den Endschaltersignalen die Achsentriebe ein 
bzw. aus; bei Industrierobotern mit Bahnsteuerung besteht sie im Prinzip aus einem Bahn¬ 
kurvenrechner (Interpolator), der in Echtzeit die Weg-Zeit-Verläufe der geforderten Be¬ 
wegung ermittelt und als Sollwerte an die Lageregelung ausgibt. Bei hochwertigen Steu¬ 
erungen kommt noch ein Funktionsblock für die Koordinatenwandlung hinzu. In der 
Bewegungssteuerung konzentriert sich in der Regel die numerische Verarbeitung des IR- 
Steuerungssystems. 



Bild 2.8 

Funktionssteuerung eines Industrieroboters 
(nach [2.4]) 


Die Aktionssteuerung (Bild 2.8 rechts) wertet die Aktionsbefehle des Roboter¬ 
programms aus und steuert in Abhängigkeit davon die technologischen Aktionen des 
Roboters und der Peripherie über entsprechende Effektoren. Da die Aktionsbefehle eines 
Roboters in der Mehrzahl zweiwertige Wirkungen hervorrufen (z.B. Greifer auf-zu, 
Farbstrahl ein-aus, Rundtisch weiterschalten) und auch die zu ihrer Überwachung ein¬ 
gesetzten Sensoren (gegenwärtig noch) überwiegend binäre Signale abgeben, herrscht 
in der Aktionssteuerung die nichtnumerische (binäre) Verarbeitung vor. Beispiele für 
numerische Steuerungsprobleme in dieser Wirkungslinie sind die Regelung des Schweiß¬ 
stroms bei Lichtbogenschweißrobotern und die Regelung der Intensität des Farbstrahls 
bei Farbspritzrobotern entsprechend den numerischen Vorgaben im Roboterprogramm. 

Das Niveau der in der Funktionssteuerung installierten Informationsverarbeitung 
zeigt sich in der Adaptivität des Roboters, d.h. in seiner Fähigkeit, auf Situationsände¬ 
rungen in der technologischen Umwelt zu reagieren. Erreicht wird dies durch Informa¬ 
tionsrückführungen auf verschiedenen Verarbeitungsniveaus. Im Bild 2.8 sind ganz links 
einige Möglichkeiten solcher Rückführungen angegeben. In Richtung zunehmender 
Adaptivität sind zu unterscheiden: 

A. Rückführungen ohne Verarbeitung in der Steuerung 

Sie werden durch geeignet nachgebende mechanische Konstruktionselemente erreicht. 
Ein typisches Beispiel ist das RCC-Glied (RCC remote-center of compliance), ein 
mechanischer Fügekopf, der das Verklemmen beim Fügen von Bolzen in Bohrungen 
durch Verlagerung des Momentanpols der Drehbewegung mit Hilfe nachgiebiger Ele¬ 
mente vermeidet und in der Montage Einsatz findet. 
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B. Rückführungen auf der Ebene der Servoantriebe 

Damit sind quantitative koordinatenspezifische Korrekturen der Bewegungsbahn in Ab¬ 
hängigkeit von Sensorsignalen möglich. Das wird im einfachsten Fall durch Aufschal¬ 
tung von Korrekturwerten auf die Sollwerte für die Lageregelung realisiert. Ein typischer 
Anwendungsfall sind Bahnkorrekturen beim Lichtbogenschweißen, wenn durch die 
Schweißteiltoleranzen die zu schweißende Naht von der einprogrammierten Bahn ab¬ 
weicht und diese Abweichung in einer Achse durch ein Nachführsystem mit Näherungs¬ 
sensor ausgeglichen wird. 

C. Rückführungen auf der Ebene der Geometriesteuerung 

Hier können quantitative und qualitative Bahnänderungen ausgeführt werden. Dazu 
werden in der Regel Bahnelemente, die nicht im Programm vorgesehen sind, selbsttätig 
in die programmierte Bewegungsbahn eingefügt. Ein typischer Anwendungsfall ist das 
automatische Umfahren von Hindernissen nach deren Erkennung durch geeignete 
Sensorsysteme. Auch die programmtechnische Einschränkung des Arbeitsbereichs von 
Industrierobotern läßt sich funktionell hier einordnen. Sie erfolgt dadurch, daß die 
programmierte Bahn ständig darauf überprüft wird, ob sie die Grenzen des einprogram¬ 
mierten Bewegungsfreiraums überschreitet, und in Abhängigkeit von dieser Prüfung als 
zulässig erkannt und verfahren oder durch eine andere Bewegungsbahn an den Frei¬ 
raumgrenzen ersetzt wird. 

D. Rückführung auf der Ebene der Programmsteuerung 

Sie gestattet eine selbständige Bewegungs- und Aktionsplanung auf der Basis einer kom¬ 
plexen Erfassung des Zustands der technologischen Roboterumwelt, die mit einem in der 
Steuerung programmierten Umweltmodell verglichen wird. Roboter mit solchen Steue¬ 
rungen gestatten eine zielorientierte Programmierung (im Unterschied zur algorithmisch 
orientierten oder „expliziten“ Programmierung aller anderen Typen). 

Rückführungen der Art A werden bereits bei Robotern der ersten Generation ein¬ 
gesetzt, solche der Arten B und C sind für die zweite, solche der Art D für die dritte 
Generation typisch. 

2.4.2. Ablaufsteuerung und Befehlsarten 

Die Ablaufsteuerung realisiert den Gesamtablauf von Bewegungen und Aktionen gemäß 
dem eingegebenen Programm. Sie greift auf den Programmspeicher zu und sorgt für die 
sequentielle Ausführung der dort abgelegten Befehle. 

Einfache Handhabegeräte kommen mit einer Ablaufsteuerung mit festem Programm¬ 
ablauf aus (Bild 2.9 a). Die Ablaufsteuerung reduziert sich auf ein Schrittschaltwerk, das 
bei Eintreffen gewisser Quittungssignale aus Roboter oder Peripherie (z. B. Erreichen von 
Endlagenschaltern) inkrementiert wird, worauf der nächste Befehl der Funktionssteuerung 
zur Ausführung übergeben wird. Realisierungsbeispiele sind Kugelschrittschaltwerke und 
über Schrittschaltwerk angesteuerte Steckerfelder. 

Bereits das einfache Beispiel im Bild 2.9 a zeigt, daß aus dieser Sicht eine Industrie¬ 
robotersteuerung als programmierbares System im Prinzip die Grundstruktur eines 
Rechners besitzt: sie verfügt über einen Programmspeicher; Ablaufsteuerung und Funk¬ 
tionssteuerung können zu einer verarbeitenden Einheit („Prozessor“) zusammengefaßt 
werden, und es gibt schließlich (im Bild nicht genau dargestellt) ein Eingabe-/Ausgabe- 
werk zur Kommunikation mit, von der Steuerung aus gesehen, peripheren Einrichtungen. 
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Bei festem Programmablauf werden alle Befehle von der Funktionssteuerung ausge¬ 
führt, die so dem Operationswerk (ALU) eines Rechners entspricht. Eine Ausnahme 
bildet im Bild 2.9 a lediglich der Programmendebefehl (END), der als Organisations¬ 
befehl auf die Ablaufsteuerung wirkt. 



Bild 2.9 

Ablaufsteuerung (nach [2.1]) 

a) mit festem Programmablauf 

b) mit programmierbarem 
Programmablauf 
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Werden weitere Organisationsbefehle und die Möglichkeit ihrer Verarbeitung vor¬ 
gesehen, so kommt man zur Ablaufsteuerung mit programmierbarem Programmablauf 
(Bild 2.9 b). Hier muß vor Ausführung jedes Befehls geprüft werden, ob er als funktionel¬ 
ler Befehl der Funktionssteuerung oder als organisatorischer Befehl der Ablaufsteuerung 
zur Ausführung zugeleitet wird. Dafür ist eine Funktionsgruppe „Dekodierung“ inner¬ 
halb des Prozesses zuständig. Funktionelle Befehle lösen eine Bewegung oder Aktion des 
Industrieroboters unmittelbar aus. Typische Beispiele sind: 

Bewegungsbefehle 

Bewege Achse X bis zum Endpunkt. 

Fahre auf einer Geraden vom aktuellen Raumpunkt bis zum Punkt {X, Y, Z). 

Aktionsbefehle 
Greifer auf. 

Schalte Steuerleitung Nr. N ein. 

Wartebefehle 

Setze den Programmablauf nach n Sekunden fort. 

Warte, bis Steuerleitung Nr. N eingeschaltet wird. 

Organisatorische Befehle wirken auf den Programmablauf. Ihre Ausführung kann von 
Bedingungen (Erreichen vorgegebener Zustände des Gesamtsystems) abhängig sein. Zu 
ihrer Ausführung verfügt die Ablaufsteuerung über einen einstellbaren Befehlszähler und 
Funktionsgruppen, die in Abhängigkeit vom auszuführenden Befehl und den erfüllten 
Bedingungen entscheiden, welcher Adreßwert in den Befehlszähler eingetragen und 
welcher Befehl damit als nächster Befehl ausgeführt wird. 

Typische Beispiele für organisatorische Befehle sind: 

Sprungbefehle 

Setze das Programm bei Befehl Nr. A fort. 

Setze das Programm bei Befehl Nr. B fort, wenn Signalleitung Nr. N eingeschaltet ist. 

Unterprogrammaufrufbefehle und Rückkehrbefehle 
Rufe das Unterprogramm mit Namen U auf. 

Kehre ins Hauptprogramm zurück. 

Die grundsätzliche Befehlsabarbeitung in einem programmierbaren System nach 
Bild 2.7 ist im Bild 2.10 dargestellt. 

Sie gliedert sich in die Phasen 

Befehlsaufstellung, bei der der Befehl in die verarbeitende Einheit (Prozessor) geholt wird, 
und 

Befehlsdekodierung und -ausführung, bei der der Befehl zuerst entschlüsselt und an¬ 
schließend an die betroffene Funktionsgruppe zur Ausführung weitergeleitet wird. • 

Die Befehlsaufstellung ist immer eine Transportoperation aus dem Programmspeicher 
in den Prozessor; die Dekodierung wird im Prinzip durch eine Mehrfachverzweigung 
realisiert, und die Ausführung besteht in der Regel in einer Folge von numerischen und 
nichtnumerischen Operationen in der Programmablauf- oder in der Funktionssteuerung. 

2.4.3. Dialogsteuerung und Betriebsarten 

Im Bild 2.11 ist die prinzipielle Gesamtstruktur der Steuerung eines autonom arbeitenden 
Industrieroboters zusammenfassend dargestellt. Die wesentlichsten Informationsflüsse 
zwischen den Funktionseinheiten sind eingetragen. Deutlich zu erkennen sind die Hier- 
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Bewegungs- Aktionssteuerung Ablaufsteuerung 

Steuerung 

Bild 2.10. Befehlsabarbeitung in einer IR-Steuerung 



Bild 2.11. Gesamtstruktur einer IR-Steuerung mit wesentlichen Informationsflüssen 

































2.4. Grundstruktur einer Industrierobotersteuerung 


27 


archieebenen aus Bild 2.7 und die Zweiteilung der Funktionssteuerung nach Bild 2.8. 
Mit „IR-Grundgerät“ (im Bild unten links) ist der kinematische Teil des Roboters be¬ 
zeichnet, der die Bewegung ausführt, und unter den „technologischen Effektoren“ (im 
Bild unten rechts) sollen alle Elemente verstanden werden, die technologisch relevante 
Aktionen ausführen. Solche Elemente können sich am Grundgerät selbst (Greifer, 
Schweißzange) oder in der Peripherie (automatische Spanneinrichtung, Schwenktisch) 
befinden. 

Die Dialogsteuerung enthält Funktionsgruppen zur 

- Kommunikation mit dem Bediener/Programmierer über das Bedienfeld, 

- Wahl bzw. Einstellung der Betriebsart und 

- Überwachung und Diagnose des Gesamtsystems Grundgerät-Steuerung-Peripherie. 

Diese Funktionsgruppen sind bei verschiedenen Steuerungstypen unterschiedlich aus¬ 
gebaut und können auch ganz fehlen; die beiden ersten Funktionen sind jedoch immer 
vorhanden. 

Die Betriebsarten der Industrierobotersteuerung werden je nach Steuerungstyp- und 
-hersteiler unterschiedlich festgelegt. Als Hauptbetriebsarten finden sich in der Regel 

- Programmieren, 

- Arbeiten und 

- Halt. 

Bei anspruchsvolleren Steuerungen gehört zu jeder Hauptbetriebsart ein mehr oder 
weniger gestaffeltes System von Unterbetriebsarten. Einige Möglichkeiten sollen nach¬ 
stehend aufgeführt werden. 

Programmieren 

Diese Hauptbetriebsart dient zur Erzeugung eines ablauffähigen Roboterprogramms im 
Arbeitsspeicher der Programmsteuerung. Sie kann in die Unterbetriebsarten 

- Programmeingabe, bei der das eigentliche Programmieren erfolgt oder das Programm 
von einem externen Datenträger (z.B. Magnetbandkassette) eingegeben wird; 

- Programmtest und -korrektur, bei denen über das Bedienfeld Zugriff zum Arbeits¬ 
speicher besteht und einzelne Befehle geändert, hinzugefügt oder aus dem Programm 
entfernt werden können. Daneben kann das Programm schrittweise unter Bediener¬ 
führung bei wahlweise zu- oder abgeschalteten Antrieben und technologischen Effek¬ 
toren ausgeführt werden. 

Arbeiten 

In dieser Hauptbetriebsart wird das Roboterprogramm ausgeführt. Hier werden Unter¬ 
betriebsarten wie 

- Automatik (das Programm wird automatisch und wiederholt abgearbeitet), 

- Einzelschritt (das Programm wird schrittweise abgearbeitet; für jeden neuen Pro¬ 
grammschritt ist eine Bedienhandlung erforderlich), 

- Handbetrieb (Bewegungen und Aktionen des Roboters können durch Handeingabe 
entsprechender Anweisungen direkt ausgeführt werden) 

unterschieden. Die beiden letztgenannten Betriebsarten überdecken sich teilweise mit 
denen zum Programmtest. 
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Halt 

In dieser Betriebsart steht der Industrieroboter. Sie kann über Programmbefehl oder vom 
Bedienfeld angewiesen oder aber durch ein externes Signal (bei Havariegefahr Not-Halt) 
herbeigeführt werden. 


2.5. Einteilung von Industrierobotersteuerungen 


Die Vielzahl der verschiedenen Arten von Industrierobotern können nach unterschied¬ 
lichen Gesichtspunkten klassifiziert werden [2.5] [2.6]. Eine Möglichkeit, die vom Einsatz¬ 
fall ausgeht, ist mit ihren Konsequenzen für die einzusetzenden Steuerungen im Ab¬ 
schnitt 2.1. (s. auch Bild 2.2) besprochen worden. Nachfolgend soll eine Möglichkeit der 
Klassifizierung von IR-Steuerungen behandelt werden, die sich auf den Charakter der 
Bewegungssteuerung und die Programmierungsart bezieht. Diese Einteilung, die bezüg¬ 
lich der Auslegung einzelner Funktionsgruppen und der Gesamtstruktur Konsequenzen 
nach sich zieht, hat sich - wenn auch mitunter mit verschiedener Nomenklatur - allgemein 
eingeführt (z.B. [2.7] [2.8] [2.10] [2.11]). 

Danach werden IR-Steuerungen mit 

- Punkt-zu-Punkt-Verhalten (PTP-Steuerungen) und 

- Bahnverhalten 

unterschieden. 


1. START BEI PI 

2. GEHE NACH P2 

3. WENN P2 ERREICHT, AKTION A2 

4. WENN A2 BEENDET, GEHE NACH P3 

5. WENN P3 ERREICHT, AKTION A3 

1. START BEI PI 

2. GEHE NACH P2 

3. GEHE NACH P3 

4. GEHE NACH P4 

5. AKTION Al 

6. GEHE NACH P5 


1. START BEI PI 

2. GERADE BIS P2 

3. AKTION Al 

4. PARABEL DURCH P3 BIS P4 

5. KREIS U7 Ml BIS P5 



Bild 2.12. Klassifikation von IR-Steuerungen nach dem Bewegungsverhalten 
a) Punkt-zu-Punkt-Steuerung (PTP); b) Multipunkt-Steuerung (MP); c) Bahnsteuerung (CP) 


Punktsteuerungen gestatten das Abspeichern und sequentielle Anfahren einer Folge 
diskreter Raumpunkte. Bild 2.12a zeigt dazu eine mögliche Bewegungs-und Aktions¬ 
folge mit Programmbeispiel in umgangssprachlicher Formulierung. Die Bewegungsbahn 
zwischen den einzelnen Punkten ist nicht definiert; die Achsen fahren dort ohne Funk¬ 
tionszusammenhang. Punktsteuerungen finden vorwiegend bei Handhabegeräten und 
Punktschweißrobotern Einsatz (s. Abschn. 2.1.). 



2.6. Industrierobotersteuerungen auf Mikrorechnerbasis 
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Die einzelnen Punkte werden auf die Positioniergenauigkeit des Roboters genau ange¬ 
fahren. Erst nach genauer Positionierung auf den programmierten Punkt wird der nächste 
Befehl aufgerufen. Mitunter ist diese Präzision nicht erforderlich (z. B. beim Umfahren 
von Hindernissen), und der Zeitverlust für den Positioniervorgang ist eher störend. Für 
diesen Fall bieten einige PTP-Steuerungen die Möglichkeit der Verwendung von Hilfs¬ 
punkten (Überschleifen); dabei wird nach Erreichen einer definierten Umgebung des 
Hilfspunktes die Bewegung nicht unterbrochen, sondern mit der vorgegebenen Ge¬ 
schwindigkeit zum Folgepunkt weitergefahren. Ist im Bild 2.12 a z. B. P2 ein solcher 
Hilfspunkt (Al möge entfallen), dann erhält Befehl Nr.2 die Form 

2. GEHE ÜBER HILFSPUNKT P2. 

Eine Steuerung mit Bahnverhalten gestattet die Programmierung und das Verfahren 
definierter Bewegungsbahnen mit Funktionszusammenhang der Bewegungen in den 
einzelnen Achsen. Dafür bestehen zwei Möglichkeiten: 

Multipunkt- (MP-) Steuerungen enthalten das Bewegungsprogramm in Form einer 
dichten Sequenz von Raumpunkten, die in rascher zeitlicher Folge (etwa alle 10 bis 
100 ms) an die Lageregler der Achsen ausgegeben werden. Die Trägheit der Antriebs¬ 
systeme sorgt für ein ruckfreies Verfahren der Achsen, deren Funktionszusammenhang 
durch den Synchronismus der Vorgaben der achsspezifischen Sollwerte gewährleistet 
wird. Bild 2.12 b veranschaulicht die Vorgänge. Die Aktion Al wird dabei ausgelöst, nach¬ 
dem die Koordinatenwerte von P4 an die Lageregler ausgegeben worden sind, und zwar 
unabhängig davon, ob diese Position bereits erreicht worden ist oder nicht. Der dadurch 
auftretende geringe Zeitverzug kann in der Regel in Kauf genommen werden. 

Multipunktsteuerungen werden vorwiegend für Farbspritzroboter, aber auch beim 
Lichtbogenschweißen und bei der Oberflächenbearbeitung (Schleifen, Polieren) ein¬ 
gesetzt, Dem Nachteil des höheren Speicherplatzbedarfs durch das Abspeichern einer 
Vielzahl von Raumpunkten kann durch geeignete Verfahren zur Informationsverdich¬ 
tung bei der Aufnahme und Datendekompression bei der Wiedergabe bis zu einem ge¬ 
wissen Grad begegnet werden. 

Bahn- (CP-) Steuerungen gestatten das Verfahren mathematisch definierter Bewegungs¬ 
bahnen. Bild 2.12 c zeigt dazu ein Beispiel. Die Programmierung erfolgt im indirekten 
Teach-in- oder textuell (s. Abschn. 6.2.). Das Roboterprogramm steht in der im Bild 2.12c 
angedeuteten Form kodiert im Speicher. Ein Bahnkurvenrechner (Interpolator) ermittelt 
in Auswertung des jeweiligen Bewegungsbefehls eine Anzahl von Zwischen werten auf der 
angewiesenen Bahnkurve und gibt sie entsprechend der programmierten Geschwindig¬ 
keit an die Lageregler aus. Typische Einsatzfälle für CP-Steuerungen sind Lichtbogen¬ 
schweißen, Gußputzen und Entgraten. 


2.6. Industrierobotersteuerungen auf Mikrorechnerbasis 

Bei der Realisierung von elektronischen Steuerungen für Industrieroboter hat sich der 
Mikrorechner als universelles und flexibles informationsverarbeitendes System durch¬ 
gesetzt. Die Hardwarestruktur, d.h. die gerätetechnische Konfiguration, ist dabei weit¬ 
gehend standardisiert. Eine für eine IR-Steuerung mögliche Variante ist im Bild 2.13 an¬ 
gegeben. Sie besteht im Kern aus einer zentralen Verarbeitungseinheit (ZVE), die im 
wesentlichen aus einem Mikroprozessor gebildet wird, dem Festwertspeicher (ROM), 
der die Arbeitsprogramme enthält, und dem Schreib-Lese-Speicher (RAM), in den zeit¬ 
weilig Programmteile und Daten eingetragen werden. Diese Funktionseinheiten sind 
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untereinander und mit der Bedien- und Programmierperipherie (im Bild oben rechts) und 
der Prozeßperipherie (unten) durch ein System von Datensammelleitungen (Bus) ver¬ 
bunden. Die eigentliche Funktion einer Robotersteuerung erhält das System durch die 
Software, d.h. durch die Gesamtheit der Programme, die in den Arbeitsspeicher (ROM 
und RAM) des Rechnerkerns eingetragen werden. Dazu wird der Funktionsinhalt der 
IR-Steuerung in Teilfunktionen zerlegt und für jede dieser Funktionen ein Software¬ 
modul entwickelt. Eine Übersicht über solche Funktionsmodule ist im Bild 2.14 zusam¬ 
mengestellt [2.13]. Diese Funktionsmodule sind nicht voneinander unabhängig, sondern 
größtenteils miteinander funktionell verbunden. So muß z. B. der Funktionsmodul 
„Synchronisierung“ Einfluß auf den Steuerungsablauf nehmen, und die Sollwerte für die 
Adreßbewegung müssen den Servoreglern im richtigen Zeitpunkt zur Verfügung gestellt 
werden. Einige der Verarbeitungsaufgaben, wie gerade die Servoregelung, stellen Echt¬ 
zeitforderungen und müssen in einem vorgegebenen Zeitraster bearbeitet werden; andere 
Prozesse, wie die Kollisionsraumüberwachung, müssen nahezu ständig laufen und kon¬ 
kurrieren um die Bearbeitung durch den Prozessor. 


Schnittstelle für 

Rechnerkern Bedienung !Programmierung 



Sensor- Schnittstelle Schnittstelle für Antriebe 

Schnittstelle für binäre 


Signalgeber 
und Effektoren 


Bild 2.13 

Hardwarestruktur einer Steue¬ 
rung auf Mikror^chnerbasis 


Da die ZVE entsprechend dem Rechnergrundprinzip (s. Abschn. 2.4.2.) die Befehle 
eines Programms nur sequentiell verarbeiten kann, sorgt ein spezielles Programm, das 
Betriebssystem, für eine koordinierte Bearbeitung der einzelnen Softwaremodule. Häufig 
reicht die Verarbeitungsleistung eines einzelnen Mikroprozessors zur Realisierung aller 
Steuerungsfunktionen unter Gewährleistung der Echtzeitforderungen nicht aus. Dann 
kommen Mehrprozessor- bzw. Mehrrechnerstrukturen zum Einsatz, bei denen die be¬ 
nötigten Softwaremodule geeignet auf die einzelnen verarbeitenden Komponenten ver¬ 
teilt werden müssen. 

Sind das Betriebssystem und die erforderlichen Softwaremodule erstellt und im Arbeits¬ 
speicher des Mikrorechners implementiert, so hat das Gesamtsystem die gewünschte 
Funktion einer Robotersteuerung. Das stellt sich sehr anschaulich im sog. Schalenmodell 
(Bild 2.15) dar. Der Rechnerkern wird durch das Betriebssystem und durch die Software¬ 
module umhüllt, und dem Anwender ist nur die äußere Hülle zugänglich. Er bedient und 
programmiert also nicht den Mikrorechner (der für ihn in der Regel gar nicht zugänglich 
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Bild 2.15 

Schalenmodell einer Mikrorechnersteuerung 
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ist), sondern eine programmtechnisch realisierte IR-Steuerung. Wird eine Rechnerstruk¬ 
tur wie im Bild 2.7 über Software auf einer anderen Rechnerstruktur (hier der Mikro¬ 
rechner) realisiert, so spricht man auch von einer virtuellen Maschine. Dabei sind min¬ 
destens zwei Niveaus der Programmierung und damit auch der Programmiersprachen zu 
unterscheiden. Hier sind es 

- für den Mikrorechner die mikrorechnertypische Programmiersprache und 

- für die Robotersteuerung (virtuelle Maschine) die Gesamtheit der robotertypischen 
Befehle einschließlich der Regeln ihrer Aufeinanderfolge (Grammatik). 



besteht aus 


Betriebssystem 

Funktionsmodule 


robotertypischen 

Befehlen 


geschrieben in 


Mikrorechner- 

Programmsprache 


Roboter- 

Programmsprache 


realisiert 


Funktion einer 
Robotersteuerung 
in einem Mikro¬ 
rechner (system) 

entsteht 


bei der Steuerungs¬ 
entwicklung einmalig 


programmtechnische 
Lösung einer techno¬ 
logischen Aufgabe 


bei der Anwender- Bild 2.16 

Programmierung des Innere und äußere Software für eine 
IR wiederholt neu IR-Steuerung auf Mikrorechnerbasis 


Eine weitere virtuelle Maschine und entsprechend eine weitere Sprachebene entsteht, 
wenn im Programmiersystem ein Sprachverarbeitungsmodul zur Verarbeitung einer 
problemorientierten Robotersprache vorgesehen ist. Er ist, wie im Bild 2.15 angedeutet, 
Bestandteil einer weiteren Hülle im Schalenmodell. 

Die beiden grundsätzlichen Sprachebenen einer Industrierobotersteuerung mit einigen 
ihrer Merkmale sind abschließend im Bild 2.16 gegenübergestellt. 
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Kinematische Systeme, Antriebe und Meßsysteme 


3.1. Allgemeines 

Die Bewegung eines Roboters wird durch die Antriebe bewirkt, vom kinematischen 
System ausgeführt und mit den Meßsystemen erfaßt. Für die Auslegung der Bewegungs¬ 
steuerung ist die Kenntnis der Wirkprinzipien und des Verhaltens dieser Funktions¬ 
einheiten erforderlich. Die Grundstruktur ihrer Verkopplung ist im Bild 3.1 dargestellt. 
In Abhängigkeit von den Ansteuersignalen wirken einerseits die Antriebe mit Kräften und 
Momenten auf das kinematische System ein, das darauf mit Bewegungen reagiert; außer¬ 
dem wirken noch andere Kräfte (Schwerkraft, Reibung) auf das kinematische System 
ein. Andererseits wirkt das bewegte kinematische System auf die Antriebe zurück. 


Bewegungszustände 
der Antriebe 


Schwerkräfte 

Rückwirkungskräfte 



Steuerung 

1 Steuer- 


Einfachantriebe 

Antriebs- 

kinemat. System 

Bewegungszustände 

Umwelt 

1 Signale "" | 

(pneum., hydr., elektr.) 

kräfte " ] 

•f Werkzeug/G reifer 

Werkzeug/Greifer 


Bild 3.1. Antriebe, kinematisches System und Meßsysteme eines Industrieroboters und ihre Verkettung 


Ziel dieses Abschnitts ist es, Grundlagen für die mathematische Beschreibung der Teile 
des Industrieroboters zu erarbeiten, auf deren Verhalten die optimale Auslegung der Be¬ 
wegungssteuerung ausgerichtet sein muß. Die mathematische Beschreibung der oben¬ 
genannten Funktionseinheiten wird unter dem Aspekt der Modellbildung des dynami¬ 
schen Verhaltens der Teilsysteme Kinematik, Antriebe, Meßglieder und ihrer Wechsel¬ 
wirkung vorgenommen. Die erforderliche Güte des’Modells und der damit verbundene 
Aufwand bei der Modellierung hängen wesentlich von der durch die technologische Auf¬ 
gabe bedingten Präzision der Bewegungssteuerung ab. Quantitative und qualitative Aus¬ 
sagen über die Güte des Modells erhält man durch Vergleich von Simulationsergebnissen 
mit denen praktischer Messungen. 

Die Modelle der einzelnen Funktionseinheiten müssen dazu aufeinander abgestimmt 
und aneinander anschließbar sein. Einfach ist in diesem Zusammenhang das Anpassen der 
Meßglieder, da deren Eingangs- und Ausgangsgrößen festliegen und i. allg. Rückwirkungs¬ 
freiheit angenommen werden kann. Größere Komplexität weisen die Teilsysteme Kine¬ 
matik und Antriebe sowohl in ihrer inneren Struktur als auch in ihrer Wechselwirkung auf. 
Für die folgenden Betrachtungen wird dazu vorausgesetzt: 

1. Die Kinematikglieder sind federnd miteinander verbunden, während Kräfte direkt ins 
Gestell ohne Nachgiebigkeit eingeleitet werden. 

2. Die Antriebe wirken direkt auf diese Glieder ein. Die bewegte Antriebsmasse wird den 
Kinematikgliedern zugeschlagen, während Reibkräfte auf die Antriebe konzentriert 

3 Industrierobotersteuerung 
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werden, da zum einen die Trägheit des Kinematiksystems meist überwiegt und zum 
anderen im Antrieb eine Abhängigkeit der Antriebskraft von seiner Geschwindigkeit 
ohnehin gegeben ist. 

3. Die Beschreibung der Antriebe (im Abschn. 3.3.) ohne Berücksichtigung angelenkter 
Teile des Kinematiksystems würde zu Fehleinschätzungen des dynamischen Verhaltens 
führen. Aus diesem Grund werden im Abschnitt 3.2. einfache Glieder des kinematischen 
Systems so beschrieben, daß ihre Trägheit und die auf sie wirkenden Kräfte auf die 
Antriebsachse bezogen werden können. 


3.2. Funktionseinheiten des kinematischen Systems 

3.2.1. Beispiele kinematischer Strukturen 

Das vom Industrieroboter gehandhabte Werkstück muß im Raum positioniert und orien¬ 
tiert werden. Die Positionierung geschieht durch die drei Grund- oder Hauptachsen des 
Industrieroboters, die als Dreh- (D) bzw. Schwenkglieder oder als Schub- bzw. Linear¬ 
glieder (L) ausgelegt sein können. Die Kombination aller Varianten ergibt 2^ = 8 ver¬ 
schiedene Möglichkeiten der kine¬ 
matischen Strukturen der Gmnd- 
achsen (Bild 3.2). Die häufigsten 
Strukturen sind die DDD-Struk- 
tur, die DDL-Struktur und auch 
die in Werkzeugmaschinen über¬ 
wiegend zu findende LLL-Struk- 
tur. 



Drehglied {D) 




Bild 3.2 

Acht Möglichkeiten der kinematischen 
Struktur der Industrieroboter¬ 
grundachsen 
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Ausgehend von den allgemeinen Bewegungsgleichungen eines starren Kinematik¬ 
glieds wird im Abschnitt 3.2.3. die Bewegung von Schubgliedern und im Abschnitt 3.2.4. 
die Bewegung von Schwenkgliedern beschrieben. 


3.2.2. Allgemeine Bewegung eines starren Kinematikglieds 

Die allgemeine Bewegung eines starren Körpers läßt sich als Überlagerung einer Trans¬ 
lation und einer Rotation um den Schwerpunkt darstellen. Folglich müssen zu ihrer Be¬ 
schreibung zwei Gruppen von Bewegungsgleichungen angesetzt werden. 



Bild 3.3 

Starres Kinematikglied mit drei angreifenden 
Kräften 

a) Schema; b) detailliertes Signalflußbild mit Darstellung 
aller zwölf Integrationen (die Komponenten der vektoriellen 
Größen beziehen sich auf die jeweiligen Punkte P(); 
c) allgemeines Signalflußbild zur Deflnition aller Ein- und 
A usgangsgrößen 
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Generell gelten für ein gerades, starres Kinematikglied mit n Kraftangriffspunkten 
(Bild 3.3, « = 3) ohne Berücksichtigung der Reibkräfte folgende Kräfte- und Momenten¬ 
gleichgewichte : 

= Z 

msy = Z Fiy 

ms, = X Fiz 

(3.1) 

Jsx^x — -|- ^Ll,Fiy 

~ Z Z 

Jsz^z FixFfy + Z FfyFfx, 

m Masse des Kinematikglieds, im Schwerpunkt konzentriert 

Js Massenträgheitsmoment des Gliedes um den Schwerpunkt S 

X, y, z Komponenten in x, y, z-Richtung oder um zu x, y, z parallele Achsen 

j lfd. Nummer der Kraftangriffspunkte 

s Translation des Schwerpunktes 

(p Rotation um den Schwerpunkt 

's geradlinige Beschleunigung 

(p Winkelbeschleunigung. 

Die Beziehungen (3.1) gelten auch, wenn ein Moment am Kinematikglied angreift. Es 
kann dann in ein Kräftepaar zerlegt werden. Dieser Ansatz wird im Abschn. 4.2. an¬ 
gewendet. 

Die zweimalige Integration aller sechs Beschleunigungsgrößen im Gleichungssystem 
(3.1) ergibt die entsprechenden Weg- und Winkeländerungen bezüglich des Schwerpunk¬ 
tes. Bei linearisierter Betrachtung kleiner Schritte sind die Wegänderungen für die 
Punkte P; des Kinematikglieds: 

iSSix = AJ;, + L^y tSCp, -I- Ll, tStPy 

tss^y = -t- L^x ^(pz + Li, ^(px (3.2) 

^Si, = ^s, + Lix ^(fy + Liy Atpx. 

Günstig darstellbar sind derartige Zusammenhänge in Signalflußbildern, vor allem, wenn 
zu Verzögerungen führende Integrationen oder Verzögerungsglieder enthalten sind 
(Bild 3.3 b), da Grundzusammenhänge (hier für Beschleunigungen s, <p, Geschwindig¬ 
keiten s, (p, Wege s bzw. Winkel 9 ?) und Bilanzen (hier für Wege, später für Kräfte, 
Ströme usw.) sowie die Wirkungswege gut erkennbar sind. Blöcke mit integrierender 
Wirkung sind an der Integration einer Sprungfunktion im jeweiligen Block und am rezi¬ 
proken Differentialoperator I//7 erkennbar. 

Im Bild 3.3 c ist das allgemeine Signalflußbild zur Definition der Ein- und Ausgangs¬ 
größen angegeben. 


3.2.3. Schubglied 

Ein Schubglied beschreibt eine allgemeine Bewegung, wenn sich zwischen ihm und dem 
Gestell weitere bewegte Kinematikglieder befinden. Einfach zu beschreiben ist der Fall, 
daß sich das Schubglied auf einer in Ruhe befindlichen, steifen Unterlage befindet 
(Bild 3.4). 
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Die einfache Darstellung resultiert vor allem daraus, daß sich Trägheit und Schwer¬ 
kraft nicht mit dem Weg s verändern. 



Bild 3.4 
Schubglied 

a) Schema; b) Signalfluß (Reibung dem 
Antrieb zugeschlagen) antreibende 
Kraft; Schwerkraft 


3.2.4. Schwenkglied 

Bei der Beschreibung eines solchen Gliedes ergeben sich trotz Annahme des Spezial¬ 
falls, daß sich das übrige kinematische System in Ruhe befindet und ideal steif ist, 
kompliziertere Zusammenhänge als beim Schubglied. Im Bild 3.5 sind drei Strukturen 
eines Schwenkglieds angegeben: 

Struktur Sl: Angriffspunkt einer antreibenden Kraft Ff^ zwischen Schwerpunkt P und 
Schwerpunkt S 

Struktur S2: Angriffspunkt von außerhalb der Strecke PS 
Struktur S3: Angriffspunkt eines Schwenkmoments im Punkt P. 

Die Momentengleichgewichte sind wie folgt anzugeben: 

Sl und S2: (/g + mls)<pi = - Fgrg - Fl^l (3.3) 

S3: (Js + mls)<pi = - Fgrg - Fi^rL (3.4) 

(Nach dem Satz von Steiner gilt Jp = Js + mli-) 

In diesen Gleichungen sind 
Kraftarm 
fs, Tl Lastarme 
4 Trägheitsarm 

Jp, Js Massenträgheitsmomente bezüglich Punkt P und Schwerpunkt S. 

Die Kraft- und Lastarme ändern sich - das ist aus Bild 3.5a bis c zu erkennen - in Ab¬ 
hängigkeit von der Lage des Schwenkglieds, während der Trägheitsarm 4 bei konstantem 
Schwerpunkt konstant bleibt. 

Für die Lastarme sind folgende einfache Beziehungen für Sl, S2, S3 anzugeben: 
rg = 4 cos (pi 

(3.5) 

Tl = 4 cos (90° + (fl - (ps) = 4 sin - 99,). 

Es sei darauf hingewiesen, daß die Lastarme negative Werte annehmen können (z. B. bei 
<Pi > 9 ^ 3 ). 



Schwenkglied 

a), b), c) verschiedene Strukturen; d), 
e) Signalflußbilder der auf die Antriebs¬ 
achsen reduzierten Größen (im Arbeits¬ 
punkt linearisiert) 


Schwenkbereich bei xai = *■ 20cm 



-90 -60 -30 0 30 60 90\ (p° 120 

-- ^A1 = 0 

—— = +20cm 

Bild 3.6. Abhängigkeit reduzierter Massen und Kräfte eines Schwenkgliedes vom Arbeitspunkt 

■fsred Antriebsachse reduzierte Schwerkraft; reduzierte bewegte Masse 
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Für den Kraftarm der Strukturen S1 und - in Klammern - S2 gilt 


rx = Lx sin {cp 2 - (pi) 


(3.6) 


cp 2 = arccos 


<±>/aCOS <pi - 


J (<±, /aCOS 9?! - Xai)^ + (<±, /Asin 9?1 - Jai)^ 


Im Bild 3.5a sind jcai > 0, y^i < 0 und im Bild 3.5b atai < 0, Jai < 0- 
Werden diese Zusammenhänge auf die Achse der antreibenden Kraft bzw. des an¬ 
treibenden Moments bezogen - beachte djdtpi = r^l so ergeben sich folgende 
reduzierte Größen: 


Sl, S2: Wred 


Js. + mll 


= (3.7) 

rx 

= Fl, — 

S3: Jp = 7s + 

^sred = Fsrs (3.8) 

^Lred ~ -^L^L* 

Für die Struktur Sl wurden zwei Beispielfälle berechnet mit jeweils /a = 20 cm‘ 
4 = 100 cm, >’ai = 40 cm sowie x^i = 0 cm und x^i = +20 cm (7s wurde vernach¬ 
lässigt, Fl wurde nicht berücksichtigt). Die Ergebnisse sind im Bild 3.6 dargestellt. 

Es ist zu erkennen, daß in einem großen Bereich des theoretisch möglichen A(pi von 
180° die reduzierten Massen mehr als zwei Größenordnungen über den tatsächlich be¬ 
wegten liegen und daß der Verlauf der reduzierten Schwerkraft für Xai = 0 günstiger ist 
als für jcai = +20 cm. Bei der Konstruktion der Kinematik und bei der statischen und 
dynamischen Auslegung der Antriebe spielen derartige Betrachtungen eine wichtige 
Rolle. 


3.3. Antriebe für das kinematische System 

In den Industrierobotern kommen elektrische, hydraulische und pneumatische Antriebe 
zum Einsatz. Für einfache oder sich selten ändernde Handhabungsaufgaben können sie 
sehr einfach aufgebaut sein. Die freie Programmierbarkeit bei hoher Auflösung des Ver¬ 
fahrbereichs setzt jedoch, unabhängig von der gewählten Hilfsenergie, meist eine Lage¬ 
regelung dieser Antriebe voraus. Bei Beachtung der Grenzen des dynamischen Verhaltens 
ist auch der Einsatz von Schrittantrieben möglich. In Tafel 3.1 sind, ausgehend von den 
Handhabungsaufgaben, verschiedene Antriebsarten gegenübergestellt. 

Ausführlich wird auf die in Lageregelungen eingesetzten elektrohydraulischen und 
elektrischen Antriebe eingegangen. Die Erarbeitung von Modellen ihres dynamischen 
Verhaltens ist vor allem als Grundlage der im Abschnitt 4. behandelten Bewegungs¬ 
steuerungen notwendig, da diese Antriebe für die Realisierung auch dynamisch anspruchs¬ 
voller Handhabeaufgaben am geeignetsten sind. 
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Tafel 3.1. Eignung typischer Antriebsvarianten für bestimmte Handhabungsaufgaben 


Handhabungsaufgabe 

Lagegeregelter Antrieb 

1 

Schrittantrieb 

Einfachantrieb 

Handgesteuerter 

Synchronmanipulator 

geeignet 

nicht geeignet 

nicht geeignet 

Festprogrammierter 

Manipulator 

zu aufwendig 

geeignet, aber 
meist zu auf¬ 
wendig 

gut geeignet, pneumati¬ 
scher Einfachantrieb 
meist am wirtschaftlich¬ 
sten 

Textuell programmier¬ 
barer Industrieroboter 

vor allem bei hoher 
Auflösung des Verfahr¬ 
bereiches wirtschaftlich 

gut geeignet 

nur geeignet, wenn viele 
Anschläge oder End¬ 
schalter, deren Wirksam¬ 
sein programmiert wer¬ 
den kann, im Verfahr¬ 
bereich vorhanden sind 

Industrieroboter, indirekt 
teach-in-programmierbar 
(s. Abschn. 6.) 

geeignet 

bedingt geeignet 

nicht einsetzbar 

Industrieroboter, direkt 
teach-in-programmierbar 
bei kraftlosen Antrieben 

geeignet: elektro¬ 
hydraulische Antriebe 
bedingt geeignet: pneu¬ 
matische mit elektrischer 
Bremse 

nicht geeignet: elektri¬ 
sche und elektro-pneu- 
matische wegen sehr 
hoher Getriebeüber¬ 
setzungen 

nicht einsetzbar 

1 

nicht einsetzbar 

Industrieroboter, direkt 
trach-in-programmierbar 
mit Hilfe der Antriebe 

geeignet 

bedingt geeignet 

nicht einsetzbar 


3.3.1. Elektrohydraulische Antriebe für Lageregelungen 

3.3.1.1. Struktur der Antriebe und der Druckquelle 

Im Bild 3.7 ist schematisch die Struktur des Teiles Druckquelle, Steuerventile, Ver¬ 
braucher eines Industrieroboters dargestellt. Zur Realisierung von Lageregelungen sind 
Stetigsteuerventile einzusetzen. In allen modernen Hydraulikkonzeptionen versorgt eine 
zentrale Druckquelle alle Verbraucher einer Anlage. 

Der Name Druckquelle steht dabei (analog zur Spannungsquelle) für die Sicherung an¬ 
nähernder Druckkonstanz auch bei sich ändernder Belastung durch die Verbraucher. Die 
Druckkonstanz wird bei hohen Ansprüchen an zulässige Druckschwankungen nach ge¬ 
ringen Eigenverlusten der Druckquelle mit Hilfe einer Verstellpumpe mit Druckregelung 
realisiert. Als Pumpe werden Flügelzellen-, Radial- und Axialkolbenpumpen eingesetzt. 
Als Akkumulator zur Abdeckung von Belastuiigsspitzen und zur günstigen Gestaltung 
des dynamischen Verhaltens der Druckquelle (s. Abschn. 3.3.1.4.) werden Druckflüssig¬ 
keitsspeicher (Gasblasenspeicher, Kolbenspeicher, Federspeicher) eingesetzt. Selten er- 
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füllen Konstantpumpenkombinationen die Anforderungen an die Regelgüte für den 
Druck in Industrierobotern. 

Im Bild 3.7 ist angedeutet (s. gestrichelte Leitungsführungen), daß 

- die Druckregelung direkt oder mit Vorsteuerung erfolgen kann und 

- eine ausreichend große Druckquelle die Antriebe mehrerer Anlagen, also ggf. auch 
me^irerer Industrieroboter, versorgen kann, wie viele Beispiele bereits zeigen. 

Druckstromverbraucher des Industrieroboters 



Bild 3.7. Struktur des Teilsystems Druckwelle, Steuerventile, Druckstromverbraucher eines hydraulisch 
angetriebenen Industrieroboters (dargestellt sind vier verschiedene Druckstromverbraucher) 


Die Antriebsschaltungen aus Steuerventil und Druckstromverbraucher liegen parallel 
am Druckquellendruck poQ. Zusätzliche mechanische Getriebe sind für derartige An¬ 
triebe nicht typisch. 

3.3.1.2. Bestandteile der Antriebe und ihre Modelle 

Die wesentlichen Grundbeziehungen für die Modellierung des dynamischen Verhaltens 
hydraulischer Baugruppen (s. auch [3.2] und vgl. die folgenden Bezeichnungen mit denen 
im Bild 3.8 a) sind 

- die an den Flächen Ai wirkenden Druckkräfte F, infolge der Drücke p^: 

Fi = AiPi (3.9 a) 

- die bei Kolbengeschwindigkeit s entstehenden Verschiebeölströme ßvei • 

ßvei = (3.9 b) 

- die Proportionalität zwischen gespeichertem Ölstrom Qgi und Pi = dp/dt, der Ände¬ 
rungsgeschwindigkeit des Druckes p^ im Ölvolumen Vf: 

Der Proportionalitätsfaktor ist die hydraulische Kapazität Cy 

Cy = -^ = Kß. 

Pi 


(3.9 c) 










42 


S. Kinematische Systeme, Antriebe und Meßsysteme 


Der Kompressibilitätsfaktor ß von Hydrauliköl kann unter normalen Einsatzbedin¬ 
gungen des Industrieroboterantriebs mit ß x S ■ 10“"^ MPa“^ angesetzt werden. 

- die Ölstrom-Druckabfall-Beziehungen Q = f(^p ): 
in blendenförmigen und ähnlichen Widerständen mit turbulenter Strömung, Strö¬ 
mungsquerschnitt Aot 

Q = K,A^,^~Kp (3.9 d) 

in Rohren und Schläuchen des Querschnitts Af^^ und der Länge /, laminare Strömung 

Q = K,-^\p (3.9 e) 

in Leckspalten der Höhe h, der Breite b und der Länge I, laminare Strömung 
bhA 

Q = — Ap. (3.9f) 




Bild 3.8 

Hydraulische Verbraucher in der Handhabetechnik 

a) Arbeitszylinder mit Differentialkolben (Ai = A 2 ); b) Arbeitszylinder mit beiderseitiger 
Kolbenstange ^Ai = A 2 );c) einseitig beaufschlagbarer Arbeitszylinder mit Rückstellfeder 
(in Lageregelungen hoher Genauigkeit nicht anwendbar); d) Arbeitszylinder mit Ritzel 
(Zahnstange); e) Schwenkmotor 


Während Ki als lediglich von der Dichte des Öles abhängig angesetzt werden kann, 
sind Kj und zusätzlich viskositätsabhängig. 

- die an einer Masse m wirkende Kraft Fq bei Beschleunigung s: 

Fb = ms (3.9 g) 

- die von der Geschwindigkeit s abhängige Reibkraft Fr, im einfachsten Fall geschwin¬ 
digkeitsproportional mit dem Proportionalitätsfaktor k: 

Fr = ks. (3.9 h) 

Als Bilanzen sind Kräftebilanzen an bewegten Teilen und Ölstrombilanzen in Volumina 
mit veränderlichem Druck aufzustellen. Während die Grundbeziehungen nur einmal er¬ 
mittelt werden müsseai, hängt die jeweilige Bilanz von den Gegebenheiten jeder Bau¬ 
gruppe ab. 


Verbraucher 

Im Bild 3.8 sind typische hydraulische Verbraucher für die Handhabetechnik dargestellt. 
Sie haben in drei Fällen translatorische, in zwei Fällen rotatorische Abtriebsbewegungen. 
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In jedem Fall sind sie mit dem kinematischen System gekoppelt, so daß Masse m (bzw. 
Massenträgheitsmoment J) und äußere Belastung Fl (bzw. Ml) i.allg. reduzierte Größen 
darstellen. 

In den Signalflußbildern (Bild 3.9) ist der eigentlich zum kinematischen System ge¬ 
hörende Teil gekennzeichnet. Als Kräftebilanz gilt jeweils 

ms — AiPi — A 2 P 2 ~ Fl — Fr. 



Bild 3.9. Signalflußbilder für Druckstromverbraucher 

a) ungleiche Kolbenflächen, Ölkompressibilität und inneres Lecköl vernachlässigbar; b) ungleiche Kolbenflächen, 
Ölkompressibilität berücksichtigt, inneres Lecköl vernachlässigbar; c) gleiche Kolbenflächen Ai^ = A2 = A,Q^^ = Q2 = Q, 
Ölkompressibilität und innerer Lecköl ß, berücksichtigt 
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Wegen Ai = A 2 = A im Bild 3.9c vereinfacht sich mit Pi — P 2 = ^P das Kräftegleich¬ 
gewicht dort etwas. 

Bild 3.9a zeigt das Signalflußbild eines translatorischen Verbrauchers, bei dem die 
Kompressibilität der Ölvolumina im Zylinder vernachlässigt wurde, so daß Ölstrom¬ 
bilanzen nicht ermittelt werden mußten. Eingangsgrößen sind die Drücke, Ausgangs¬ 
größen die Ölströme. 

Ist<iiese Vernachlässigung nicht erlaubt, gilt für die Volumina Vi und V 2 (s. Bild 3.8a): 
ßgi = öl ~ 

Qg 2 — ^ 2 ^ ~ Q 2 • 

Der Signalfluß des Arbeitszylinders für diesen Fall ist im Bild 3.9b dargestellt. Um Diffe- 
renzierglieder, die die Simulation der Modelle auf einem Rechner erschweren, zu ver¬ 
meiden [s. Kapazitätsgrundbeziehung (3.9c)], wurden Eingangs- und Ausgangsgrößen 
vertauscht. 

Das Leitungsvolumen ist dem Verbrauchervolumen zuzuschlagen. 

Nicht berücksichtigt wurde in beiden Signalflußbildern die Abhängigkeit des Volumens 
vom Weg. Die Linearisierung im Arbeitspunkt ist eine i. allg. ausreichende Näherung. 

Ebenso ist es nicht notwendig, für die Verbraucher mit rotatorischem Abtrieb spezielle 
Signalflußbilder bzw. Gleichungssysteme anzugeben. Da meist kleine Volumina vor¬ 
handen sind, gilt Bild 3.8a: es müssen lediglich ersetzt werden: 

- Fläche Ai durch geometrisches Verdrängungsvolumen Vg (es ist berechenbar im ein¬ 
fachen Fall, aber auch meßbar als Verhältnis von Qjtp bzw. von AF/A 99 ) 

- Masse m durch Massenträgheitsmoment J 

- alle Fi durch M,.. 

Der Arbeitszylinder mit ungleichen Kolbenflächen und großen Volumina besitzt ein 
relativ kompliziertes Modell (Bild 3.8 b). Bei gleich großen Flächen (beiderseitige Kolben¬ 
stange) ist das Signalflußbild für den Fall Qi = Qz = Q auch bei ungleichen Volumina 
F], V 2 vereinfachbar (Bild 3.9c). Da sich im Arbeitszylinder F^ und Fj gegensinnig 
verändern sowie wegen Ai = A 2 = A die Summe Fj -|- V 2 konstant bleibt, kann an¬ 
nähernd gesetzt werden: 

-1-%- Ä konst. 

Vi V 2 Vi + F 2 

Im Bild 3.9c wurde der Leckölstrom von Volumen Fi nach Volumen F 2 berück¬ 
sichtigt. 

Steuerventil 

Im Bild 3.10 ist ein zweistufiges elektrohydraulisches Servoventil dargestellt. 

Das elektrische Eingangssignal wird im Magnetsystem in eine Auslenkung der Prall¬ 
platte zwischen den zwei Düsen des Doppeldüse-Prallplatte-Systems umgewandelt. Die 
Düsen bilden mit den zwei Vordrosselventilen eine Brückenschaltung (erste Stufe), in 
deren Diagonale als Verbraucher der Hauptsteuerschieber liegt. Seine Steuerkanten 
bilden mit der Hülse vier Steuerspalte, die ebenfalls als Brücke wirken (zweite Stufe). 

In ihrer Diagonale liegt der Verbraucher. 

Die Zuordnung der Lage des Hauptsteuerschiebers zum Eingangssignal wird in der 
dargestellten Ventilvariante durch die Rückführfeder realisiert. Andere international 
angewendete Varianten sind die elektrische Lagemessung, Federn zwischen Kolben und 
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Gehäuse oder mit der Auslenkung des Steuerschiebers sich ändernde Widerstände in der 
Vorsteuerbrücke. 

Mit Hilfe eines elektrischen Eingangssignals von weniger als IW können bis zu 10 kW 
Ausgangsleistung gesteuert werden. 



Bild 3.10 

Zweistufiges elektrohydrau¬ 
lisches Servoventil (prinzipieller 
Aufbau) [ 3 . 2 ] 


Meist geringere Verstärkungen bei auch geringerem fertigungstechnischem Aufwand 
werden in Proportionalventilen erreicht, die zunehmend als Stetigsteuerventile Verwen¬ 
dung finden. Sie sind dadurch gekennzeichnet, daß ein sog. Proportionalmagnet das elek¬ 
trische Eingangssignal direkt in die annähernd proportionale Auslenkung eines Steuer¬ 
schiebers umwandelt. Im einstufigen Ventil ist dies gleichzeitig der Hauptsteuerschieber, 
der i.allg. ebenfalls als Vierkantensteuerschieber ausgeführt ist. Im zweistufigen liegt 
wiederum, wie im Servoventil, der Hauptsteuerschieber in der Brückendiagonale des Vor¬ 
steuerschiebers. Bei der Modellierung des Servoventils kann wieder auf die Grundbezie¬ 
hungen gemäß (3.9) zurückgegrifFen werden. Aus Gründen des besseren Verständnisses 
soll mit der Hauptsteuerstufe, deren Eingangsgröße der Weg ist, begonnen werden 
(Bild 3.11a). 

Die Hauptsteuerstufe ist über die Grundbeziehungen 
ßl = ^ i^HO ~~ •^h) Vpi 
ßoi = ^ (-i'HO + -yH) V/?dQ ~ Pl 
Qo2 — B (^0 “ -^h) VpdQ ~ Pz 

Ql — B {snQ + Jh)Vp2 (3.10) 

ßv ^ ßoi ~ ßi Ql ~ Qoi 
^p = Pt - Pl 
B = Kidn [s. Gl. (3.9 d)] 
zu beschreiben. 
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Bild 3.11. Hauptsteuerstufe eines Stetigsteuerventils (Servo- oder Proportionalventil mit Vierkanten¬ 
steuerschieber) 

a) Schema Hauptsteuerstufe; b) normiertes Kennlinienfeld = /(5 h), Parameter; c) Leerlaufkennlinie, normiert 


Aus den Beziehungen (3.10) ist nach mehreren Umrechnungen zu ermitteln: 

1. die dem Kennlinienfeld (Bild 3.11b) zugrunde gelegte allgemeine Beziehung 

ßv = ü (J „0 + ^h) ~ - B (i„„ - s„) (3.11) 


(erster Term gleich Null bei Jh ^ zweiter Term gleich Null bei Jh ^ -yHo) 

2. die Leerlaufkennlinie (Bild 3.11c) 

‘S'hAho 


^p = 


2pdq 
+ 1 

1 


1 + (•^h/'^ho)“ 


für Ij„| ^ Siio 

für Jh ^ -yHo 
für Sa < -5ho- 


(3.12) 


Analog zu elektrischen Brückenschaltungen kann eine Linearisierung auch dieser hydrau¬ 
lischen Brücke an einem typischen Arbeitspunkt durchgeführt werden. Das ist bei Ein¬ 
satz des Servoventils in einer Lageregelung die abgeglichene Brücke: 


ßv — 0, Jh — 0. 
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Aus dem Anstieg der Leerlaufkennlinie im Nullpunkt ist die Druckverstärkung Eq, aus 
dem Anstieg der Kurzschlußkennlinie [s. Gl. (3.11) bei Ap = 0] die Ölstromverstärkung 
Co zu ermitteln. Es ergibt sich 

Eo^^l =2£S3. (3.13) 

/ ßv = 0 -^HO 


Co 


dßv / 

/ Ap = 0 


- ^ V 2pdq * 


Das führt auf die linearisierte Beziehung der Hauptsteuerstufe 


(3.14) 


•^H 


ßv j Ap 

Co Eo 


(3.15) 


Prinzipiell ähnliche Grundbeziehungen wie in der Hauptsteuerstufe gelten auch für die 
Vorsteuerstufe. Hinzu kommen das Kräftegleichgewicht am massebehafteten Steuer¬ 
schieber als Belastung der Vorsteuerstufe, die Wirkung der Rückführfeder, das Kräfte¬ 
gleichgewicht an der ebenfalls massebehafteten Prallplatte und die Verzögerungen im 
Magnetsystem. Zwei stark verkoppelte Feder-Masse-Systeme erschweren die Modellie¬ 
rung über die Grundzusammenhänge. Untersuchungen, z. B. in [3.8], zeigen, daß bei 
Verwendung einer Ansteuerelektronik mit Stromausgang die Beschreibung der Vor¬ 
steuerstufe als proportional wirkendes Übertragungsglied mit Verzögerung 1. Ordnung, 
als sog. Pr^-Glied, ausreichend genau ist. Seine Übertragungsfunktion Gy{p) lautet dann: 

Gy{p) = —— = , (3.16) 

h\{p) 1 + Typ 

Ky statischer Übertragungsfaktor der Vorsteuerstufe 
Ty Zeitkonstante der Vorsteuerstufe, liegt im Bereich Ty = 1 bis 5 ms. 

An dieser Stelle taucht erstmals der Begriff Übertragungsfunktion G{p) auf. Sie ist der 
Quotient der Laplace-Transformierten einer Ausgangs- und einer Eingangsgröße. Sie 
steht mit der Differentialgleichung eines linearen Systems in engem Zusammenhang. 
Beim Übergang vom Zeit- in den Bildbereich mit Hilfe der Laplace-Transformation wird 
die Ableitung nach der Zeit (d/dt) zum Laplace- oder Differentialoperator p, eine zwei¬ 
fache Ableitung (d^/df^) zu p^ usw. Ein Übertragungsglied mit der Differentialgleichung 

T\x^ -b r^Xa -t- TiXa -b Xa = K (Xg -b T'x^) 

hat demnach die Übertragungsfunktion G{p) 

G(p) = = ^(1 + T'p) 

^e(p) 1 + TiP + tIp^ + TIp^ 

Die Übertragungsfunktion (3.16) entspricht im Zeitbereich der Differentialgleichung 
TySa -b % = Kyi^y. 

Die Gin. (3.15) und (3.16) führen auf das vereinfachte, linearisierte Signalflußbild des 
Servoventils nach Bild 3.1 Id, wie es für die Ermittlung der Kennwerte der Antriebe zu¬ 
grunde gelegt wird. 
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Von Servoventilen bekannte Zahlenwerte der Hauptparameter liegen bei 

Eoi = EoKy = (1 bis 3) mA“^ -poo 

und cm^ /- 

Coi = CoKy = (1 bis 3)-- \PoQ . 

s • mA • v MPa 

3.3.1.3. Übertragungsverhalten und Kennwerte der Antriebe 

Gemäß den im Abschnitt 3.1. formulierten Voraussetzungen ist für den Antrieb, be¬ 
stehend aus Steuerventil und Verbraucher, die Abhängigkeit seines Bewegungszustands 
von der auf ihn wirkenden reduzierten Kraft Fl und vor allem vom Eingangsstrom Jsv des 
Steuerventils von Interesse. 




Bild 3.12. Signalflußbild (linearisiert) der Funktionsgruppe Servoventil-Druckstromverbraucher 

a) ausführliche Darstellung; b) bis d) Stufen der Zusammenfassung 
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Servoventil und Verbraucher müssen infolge der Rückwirkung des Verbrauchers auf 
das Servoventil als Einheit betrachtet werden. Im Bild 3.12a ist ein Signalflußbild dieser 
Funktionsgruppe dargestellt. Gewählt wurde - wie meist in Industrieroboterantrieben 
angewendet - ein Arbeitszylinder mit beiderseitiger Kolbenstange. Bild 3.12a ist die Zu¬ 
sammenführung der Bilder 3.9c und 3.11 d; die Reibung wurde geschwindigkeitspropor¬ 
tional angesetzt. Da damit das Signalflußbild linear ist, können Übertragungsfunktionen 
G{p) des Systems ermittelt werden. 

Nach Bild 3.12a sind dies: 


s{p)lkyip) und s{p)IFi{p). 


Ihre Berechnung wird aufwendig, wenn z.B. aus den im Signalflußbild dargestellten 
Grundbeziehungen und Bilanzgleichungen durch Eliminieren der Zwischengrößen die 
gesuchte Abhängigkeit ermittelt wird. Der Regelungstechniker geht anders vor: Einfache 
Wirkungsschleifen werden zuerst berechnet und sich kreuzende Rückwirkungen so um¬ 
gezeichnet, daß alle an derselben Stelle beginnen und an derselben Bilanz- (Summations-) 
Stelle enden. Die gewünschte Übertragungsfunktion ist dann jeweils über den einfachen 
Ansatz 


Gip) = 


G 


vorwärts 


ip) 


1 + ^Ktcisip) 


(3.17) 


zu berechnen, wie an den folgenden Beispielen gezeigt wird. Werden die einfachen Wir¬ 
kungsschleifen im Bild 3.12a infolge der Reibkraft {k) und des Leckleitwerts ((jl) gemäß 
Ansatz (3.17) berechnet zu 


GniiP) 


1 + 


4 

(Vj + V2)ßP 
4 ^ 

(Vi + V2)ßp 

1 


1 


4 


P 


Güiip) 


^ledP _ 1 

1 ^ k + nir^aP ’ 

fTlrcdP 


SO ergibt sich aus Bild 3.12a das Bild 3.12b. 

Zur Berechnung der Übertragungsfunktionen5(p)//sv(p) und j(p)/Fl(/7 ) wurde Bild 3.12b 
in die Bilder 3.12c und 3.12d umgeformt. 

Im ersten Fall ist 

K 1 

(^voiv/äitsip) = -- - ÜqGhi (p) AGii2 (p) 

l + Typ p 


Gk,.M = G„,(P) (p) + 

Im zweiten Fall entsteht eine zusätzliche Rückführung, so daß über 


Üh3(p) 


A^Gui (p) 

I + G„,(p) 


4 Industrierobotersteuerung 
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anzusetzen sind 

^vorwärts(p) ^H2(p) 

P 

^KrelsCp) = G^2{P) ^HsCp)- 

Werden diese Beziehungen in Gl. (3.17) eingesetzt, so ergeben sich nach mehreren Zwi¬ 
schenschritten die gesuchten Übertragungsfunktionen. Ihre Form wird so gewählt, daß 
die typischen Kennwerte Eigenzeitkonstante T, Dämpfung D, Nachlaufzeitkonstante T^, 
Vorhaltzeitkonstante Ty und der statische Übertragungsfaktor Kp zwischen Kraft Fl 
und Geschwindigkeit s explizit ablesbar sind. 

Es ergibt sich 


hy{p) + 2DTp + 1 + Typ 


sjp) 

Tl(p) 


Kp 1 + Typ 


p 1 + IDTp + T^p^ 


= 


+ k[^ + Gy 
Tpi _ 

CqiA 



2DT = 


+ GL + k(Fi + 

En. 4 


Kp = 


+ k 


Üq, ^ 
— + Gl 
J^Oi 


Cpi 


+ 


A^ + k 


C, 


Oi 


+ Gl 


T' — 

1 V — 


(V, + F,) ^ 
4 

Üpi ^ 


Beachte: Cpi = CoKy, Fq. = E^Ky. 


(3.19) 

(3.20) 

(3.21) 

(3.22) 

(3.23) 

(3.24) 

(3.25) 
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Zu diesen Beziehungen können folgende Hinweise gegeben werden: 

- In der Summe + k{Coi/Eoi + Gl) ist i.allg. der dominierende Summand 
[s. Gin. (3.20) bis (3.24)]. 

- Die Eigenzeitkonstante T ist trotz großer bewegter reduzierter Massen nired infolge 
kleiner Volumina relativ klein. Mit z.B. rn^ed = 1000 bzw. 10000 kg, = Fj 
= 100 cm^ und A = 10 cm^ ergibt sich T ä 6,3 ms bzw. 20 ms. 

- Dämpfend wirken zwei Einflüsse: die Reibung und das innere Lecköl. Beide sind in 
vielen Fällen so gering, daß sich sehr kleine Dämpfungswerte {D < 0,01) ergeben, was 
sich ungünstig auf das dynamische Verhalten auswirkt. Aber künstliche Vergrößerung 
der Reibung oder des Lecköls haben innerhalb der Lageregelung negativen Einfluß auf 
die Positioniergenauigkeit. 

- Bei Einsatz eines rotatorischen Verbrauchers, etwa eines Hydromotors, reduziert sich 
das Volumen + F 2 auf die Summe der Leitungsvolumina zwischen Hydromotor 
und Servoventil. 

- Verfälschen bestimmte Linearisierungen vor allem im Servoventilmodell bei simulier¬ 
ten Einsatzfällen des Antriebs das tatsächliche Verhalten zu stark, dann sind diese zu¬ 
mindest teilweise rückgängig zu machen. Beispiele dafür werden im Abschnitt 4. be¬ 
schrieben. 


3.3.1.4. Statisches und dynamisches Verhalten der Druckquelle 

Als Funktionseinheit Druckquelle kommt für Industrieroboter vor allem die Verstell¬ 
pumpe mit sog. Nullhubregelung zum Einsatz (Schema s. Bild 3.13 a). Die sehr gute 
statische Kennlinie dieser Druckregelung (Bild 3.13 b) ist verknüpft mit dem Vorteil, daß 
die Verstellpumpe nur soviel fördert, wie die Verbraucher aktuell fordern. Der statische 
Fehler von = (0,02 bis 0,1) poo iiri Bereich der Pumpenfördermenge 0 < ßp <ßpma* 
ist für die Anforderungen der Industrieroboter zulässig. Durch das dynamische Verhalten 
verursachte Druckschwankungen können wesentlich größer sein; Möglichkeiten ihrer 
Beeinflussung werden im folgenden angegeben. 

Der Druckregelkreis kann in erster Näherung wie im Bild 3.13c dargestellt beschrieben 
werden. Die Hauptzeitkonstante der Regelstrecke wird durch den Gesamtwiderstand W 
aller Verbraucher (minimal: « Poo/Öpinax) und die Kapazität Cy des Leitungs¬ 

systems zwischen Druckquelle und Verbraucherschaltungen einschließlich angeschlosse¬ 
ner Druckflüssigkeitsspeicher bestimmt (s. auch (3.9) und [3.2]): 


T = 

WCy 

(3.26) 

W K 

PuQ 

(3.27) 

ßpmax 

Cy^ 

' \ Pdqo / 

(3.28) 


K, Volumen des Leitungssystems 
ß Kompressibilität des Öls (ß x 8 - 10~‘’'MPa“*) 

Kn Nennvolumen eines Druckflüssigkeitsspeichers 
Pgas Gasfülldruck des Speichers 
^DQo Arbeitspunkt des Druckes. 

Die Hauptzeitkonstante der Regeleinrichtung Fr liegt aus Stabilitäts- und ökonomischen 
Gründen (hochohmige Vorsteuerstufe) vielfach bei Fr « (1 bis 3) s. z' 
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Da diese Baugruppe vor allem infolge der Vorsteuerung ein sehr kompliziertes Modell 
besitzt, kann 7^ hier nicht ausführlich hergeleitet werden. 

Der statische Übertragungsfaktor .Kr ist näherungsweise aus der statischen Kennlinie 
zu ermitteln: 


Ag 

ApoQ (0,02 bis 0,1) Pdq 


(3.29) 



w 

UTs-p 



Bild 3.13 

Druckquelle für Industrieroboter 

a) Schema; b) statische Kennlinie der Druckregelung; 
c) einfaches SignalfluObild der Druckregelung 


Die Kreisverstärkung der Regelung ist 


Vo = K^W = 


Pdq _gp max _ 

gp (0,02 bis 0,1) Pdq 


= (10 bis 50) 


gpmax 

ßp 


(3.30) 


Stehen alle Verbraucher still, dann hat die Kreisverstärkung wegen W bzw. 

gp gmin ihren maximalen Wert. Für JV -* co geht die Übertragungsfunktion der 
Regelstrecke in die Form 1/CyP über. Die Störübertragungsfunktion Gz(p) lautet dann 
wie folgt [s. auch (3.17)]: 

1 

G (n) = ^ _ 1 + TrP 

^ Agv(p) , . 1 Kr , , C, _ , _ 

1 H-1 H- p H- p 

CyP 1 + TrP Kr Kr 


_ _ 1 + KrP _ 

Kr 1 + 2.DqTqP + ToP^ 
Die Dämpfung Do der Druckregelung ist 


Do 


1 /_^ 

2 V KrKr ' 


(3.31) 


(3.32) 
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Diese Beziehung sagt aus, daß eine ausreichend große Kapazität des Leitungssystems ge¬ 
schaffen werden muß, um auch an ungünstigen Arbeitspunkten eine ausreichend be- 
dämpfte Druckregelung zu sichern. Wird das ungenügend beachtet, können sehr große 
gegenseitige Beeinflussungen der Antriebe entstehen. 

Diese treten natürlich auch auf, wenn die Druckquelle nicht groß genug dimensioniert 
ist und der Druck bei schnellen Bewegungen zusammenbricht. 


3.3.2. Elektrische Antriebe für Lageregelimgen 
3.3.2.1. Struktur 

In elektrischen Antrieben für Lageregelungen werden heute vorwiegend Gleichstrom¬ 
motoren, die von an die Motorparameter angepaßten Thyristor- oder Transistorstell¬ 
gliedern angesteuert werden, eingesetzt. Im Gegensatz zu den hydraulischen Antrieben 
kommen in diesen Antrieben hochübersetzende Getriebe zum Einsatz, da die vom Elektro¬ 
motor zu realisierenden Momente für einen Direktantrieb zu klein sind. 

Die notwendige Anpassung von Motor und Stellglied hat dazu geführt, daß beide 
i.allg. als Einheit angeboten werden. Die erforderlichen Überwachungs- und Sicher¬ 
heitsschaltungen haben auf die normale Funktion und damit auf das zu ermittelnde Mo¬ 
dell keinen Einfluß. 

Anders ist das bei den in solchen Antrieben oft vorhandenen Ankerstromregelungen 
und - als Meßglied dient der in diesem Abschnitt noch zu beschreibende Tachogenerator- 
Drehzahlregelungen. Diese Regelungen sind jedoch kein Standard. In vielen Antrieben 
wird z. B. eine einfache Ankerstrombegrenzung, die nur bei hohen Beschleunigungen des 
Antriebs wirksam wird, anstelle der Ankerstromregelung realisiert; in Industrierobotern 
wird die der Lageregelung unterlagerte Geschwindigkeitsregelung oft in der Bewegungs¬ 
steuerung untergebracht (s. Abschn. 4.). 

Im Rahmen dieses Abschnitts soll in Anlehnung an den Abschnitt 3.3.1. als zu be¬ 
schreibender Antrieb die Übertragungskette Stellglied-Motor-Getriebe analysiert werden. 



a) Schema 

b) qualitatives Signalflußbild 


Bild 3.14. Struktur eines elektrischen Industrieroboter¬ 
antriebs für Lageregelungen, bestehend aus Steller, Motor 
und Getriebe 


Im Bild 3.14 sind Schema und qualitatives Signalflußbild des elektrischen Antriebs für 
Lageregelungen dargestellt. Im Signalflußbild ist der Strom 4 nur dann von Interesse, 
wenn durch den Steller eine Rückwirkung auf den informationsverarbeitenden Teil des 
Regelkreises oder auf eine Vorverstärkerstufe eintritt. Das soll im folgenden nicht der 
Fall sein. 
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3.3.2.2. Bestandteile der elektrischen Antriebe und ihre Modelle 



Das auf eine stromführende Spule ausgeübte Drehmoment ist der Stromstärke 
und dem von der Spule umfaßten magnetischen Fluß 0 proportional. Im Elektro¬ 
motor ist anzusetzen [Am ist dieselbe Motorkonstante wie in (3.34)]: 

= (3.35) 

Weitere Grundbeziehungen sind dem Abschnitt 3.3.1. zu entnehmen. 


Stellmotor 

Die Industrierobotertechnik stellt hohe Anforderungen an das Massenträgheitsmoment- 
Drehmoment-Verhältnis und an das Masse-Drehmoment-Verhältnis des Motors, da der 
Motor teilweise mitbewegt werden muß. Es wurden vor allem permanenterregte Gleich¬ 
strommotoren für diese Aufgabe entwickelt und eingesetzt [3.5]. Im Bild 3.15a ist die 
Ersatzschaltung eines solchen permanenterregten Gleichstrommotors abgebildet, im 
Bild 3.15b das zugehörige linearisierte Signalflußbild. Die darin vorkommenden Bilanz¬ 
gleichungen sind die Spannungsbilanz 

u^ - e = iR + (3.36) 

d/ 

und die Momentenbilanz, bestehend aus Beschleunigungsmoment innerem 

Motormoment Reibmoment Mr und äußerem Belastungsmoment Ml, 

Ja. ■ ~ ~ 3/l- (3.37) 

Das enthaltene Massenträgheitsmoment ist im Einsatzfall den bewegten Massen des 
kinematischen Systems zuzuschlagen. Für die Definition motorspezifischer Größen ist das 
Ankerträgheitsmoment Jx anzusetzen. 
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Wird das Reibmoilient Mr vorerst vernachlässigt, so ist das Signalflußbild einsphleifig. 
Das ist für den Motor selbst, d. h. ohne Getriebe, meist erlaubt, da diese Rückwirkung 
gegenüber der induzierten Spannung e klein ist. 



Gleichstromnebenschlußmotoren 



mit Erreger¬ 
wicklung 

mit Permanentmagneten 



Universal- 

baufor'm 

mit Scheiben¬ 
läufer 

mit Schlank¬ 
anker 

Mech. Leistung 

10.. 

. 320 W 

1 ... 320 W 

25 W... 5 kW 

100 W ... 2 kW 

Wirkungsgrad 

0,3 . 

..0,75 

0,25 ...0,8 

0,4... 0,85 

P 

P 

00 

Stromüberlast- 

2 


2 

8 

5 

barkeit 

Tk 

10.. 

. 25 ms 

5 ... 30 ms 

0,2 ... 0,5 ms 

2 ... 4 ms 

7m 

30.. 

. 40 ms 

20... 30 ms 

5 ... 20 ms 

5 ... 8 ms 


c) 

Bild 3.15. Gleichstromnebenschlußmotor mit Spannungssteuerung 

a) Schema eines permanent erregten Gleichstrommotors; b) Signalflußbiid dieses Motors; c) Kennwerte für verschiedene 
spannungsgesteuerte Gleichstromnebenschlußmotoren (nach [3.2]) 


Die Ansätze für die gesuchten Übertragungsfunktionen des Motors M(p)lut^(p) und 
M(p)IMi^(p) sind gemäß Gl. (3.17) 


bzw. 


<Pm(p) 

«m(p) 


<Pm(p) 

Mdp) 


- K^0 - 

R + Lp Jf^p p 


1 + 


1 


R + Lp 

1 1 
J\P P 




1 


JaP 


1 + 


1 




JaP 


R + Lp 
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Unter Nutzung der Beziehungen für die Ankerzeitkonstante Ta und die elektromechani¬ 
sche Zeitkonstante 


T’a = 


R 


(3.38) 


^ JxR 

M — - 

ergibt sich nach mehreren Rechenschritten 

^ _ } _ 

Um(p) pKm^ 1 + TmP (1 + T^p) 

<Pm(p) ^ R _ 1 + Tj^P 

Mdp) piKM^y 1 + T^P (1 + T^P) ' 


(3.39) 


(3.40) 

(3.41) 


Im Bild 3.15c sind Zeitkonstanten und einige weitere Kennwerte von Gleichstrom- 
Kleinmotoren aufgeführt. 


Stellglied 

Stellglieder ermöglichen durch Eingriff in den Energiefluß vom Netz zum Motor die 
Steuerung der Motorspannung hinsichtlich Vorzeichen (mit Umkehrschaltungen) und 
Betrag (mit Hilfe von Stromrichterschaltungen). In Antrieben für Industrieroboter ist 
das Stellglied eine vollelektronische Baugruppe, deren Hauptbauelemente Thyristoren, 
Leistungstransistoren oder Triacs sind. Die Ausgangsspannung ist i. allg. eine pulsierende 
Gleichspannung, deren Mittelwert die maßgebende Eingangsgröße für den Motor ist. 








b) 


Bild 3.16 
Steller 

a) Ersatzschaltbild; b) Übertragungsverhalten 


Im Bild 3.16a ist die übliche Ersatzschaltung [3.3] für derartige Steller angegeben. Die 
Ersatzspannung «ers ist die von der Eingangsspannung gesteuerte Ausgangsspannung 
des unbelasteten Stellers. Der Ersatzwiderstand berücksichtigt die Gesamtheit der 
vom Laststrom abhängigen Verluste im Stellglied, die Ersatzinduktivität die Ge¬ 
samtwirkung von Glättungsdrosseln und im Stellglied vorhandenen Streuinduktivitäten. 

Die laststromabhängigen Verluste und die Streuinduktivitäten führen im Steller zu 
mehreren kleineren Signalverzögerungen, die ohne merklichen Fehler zu einer Summen¬ 
zeitkonstante des Stellglieds Tst zusammengefaßt werden können. Oft wird das dynami¬ 
sche Verhalten vor allem der Stromrichter als mit einer Totzeit behaftet beschrieben. Wie 
Untersuchungen des Kleinsignalverhaltens ergaben, spiegelt sich dieser Ansatz im tat¬ 
sächlichen Verhalten nicht wider [3.3]. 

Der Eingangswiderstand ist i.allg. so groß, daß der Stellereingang als rückwirkungs¬ 
frei angesehen werden kann. Werden und dem Ankerkreiswiderstand R bzw. der 
Ankerkreisinduktivität L zugeschlagen (es ist dann «^rs = “st = “m zu setzen), kann der 
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Steller bei der Verarbeitung ausreichend kleiner Eingangssignale analog Gl. (3.16) als 
Pri-Glied beschrieben werden: 

MEI-(3.42) 

Me(p) 1 + T^tP 

Ksi statischer Übertragungsfaktor des Stellglieds 
Tst Verzögerungszeitkonstante des Stellglieds. 

Bei zu großen Eingangssignalen ist die Begrenzung der Ausgangsspannung des Stellers zu 
beachten. 

Der Signalfluß ist im Bild 3.16b dargestellt. 


Getriebe 

Bei exakter Beschreibung der Getriebe sind neben der seiner Aufgabe entsprechenden Be- 
wegungs- und damit Kraft- bzw. Momentenumformung vor allem folgende Einflüsse im 
Modell zu berücksichtigen : 

- die Torsionsnachgiebigkeit der antreibenden Welle 

- die Massenträgheit der Bauelemente des Getriebes 

- die Reibung 

- das Getriebespiel. 


In Industrierobotern sind die zwischen Motor und Kinematiksystem auftretenden Ver¬ 
formungen meist klein gegenüber denen im kinematischen System selbst. In den Lage¬ 
regelungen finden weitgehend spielfreie Baugruppen Anwendung. Werden zusätzlich die 
Massenträgheit dem kinematischen System und die Reibungseinflüsse denen des Motors 
zugeschlagen, genügt zur Beschreibung der Getriebe i.allg. das Übersetzungsverhältnis 
bzw. der Umsetzungsfaktor. 

Das in Industrierobotern mit lagegeregelten elektrischen Antrieben am häufigsten an¬ 
gewendeten Übersetzungsgetriebe (von Drehbewegung in Drehbewegung) ist das Well¬ 
getriebe (harmonic drive). Durch sein hohes Übersetzungsverhältnis, durch geringen 
Raumbedarf und geringe Eigenmasse ist es für Industrieroboter besonders geeignet. 

Es werden aber auch Schneckengetriebe, mit denen Übersetzungsverhältnisse bis zu 
50 erreichbar sind, angewendet. Sie sind einfacher zu fertigen, haben aber große Reibung. 
Elektrische Antriebe, die eine, translatorische Abtriebsbewegung erzeugen, besitzen ein 
Umsetzungsgetriebe von Drehbewegung auf lineare Bewegung. Dafür sind die aus den 
Werkzeugmaschinen bekannten Wälzschraubtriebe in den Industrierobotern am häufig¬ 
sten anzutreffen; es kommen aber auch Ritzel-Zahnstange-Paarungen zum Einsatz. 

In den Bildern 3.17a und b sind Schnitt und Wirkungsschema einer Variante des Well¬ 
getriebes dargestellt. Das flexible Umlaufrad wird vom ovalen Wellgenerator mit seiner 
Zahnung in die des Mittelrads gedrückt. Enthält das Mittelrad (kreisförmig) z.B. 
^MR = 102 und das Umlaufrad Zur = 100 Zähne (die Teilellipse hat einen geringeren 
Umfang als der Teilkreis; das Umfangsverhältnis muß hier 100:102 sein), so ergibt sich 
über (s. [3.1]) 


. _ tOlSI _ _ ^UR _ 

“^MR + ^UR 


(3.43 a) 


eine Übersetzung ü von 


100 

h = 


50. 


-102 4 - 100 
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Der Index 1 steht für das Übersetzungsgetriebe. Die Abtriebsdrehrichtung ist der des 
Wellgenerators entgegengesetzt (i^ < 0), die Abtriebsdrehzahl nur der des Antriebs. 

Ferner sei zum Wellgetriebe angemerkt, daß die Differenz Az = z^r — der beiden 
Zähnezahlen geradzahlig sein muß. Um das angestrebte große Übersetzungsverhältnis 
zu erreichen, wird das Minimum Az = 2 meist anzutreffen sein (s. Bild 3.17b). Dabei 
weicht die Teilellipse nur wenig vom Kreis ab, und die Zahnhöhen sind relativ gering, 
was zum einen die übertragbaren Momente beschränkt, zum anderen aber nur geringe 
Verformungen des Abtriebsrads verursacht. 



a), b) Schnittbild und Wirkungsschema eines Wellgetriebes; c) Wirkungsschema eines Schneckengetriebes; d) Übertragungs¬ 
verhalten eines Übersetzungsgetriebes 


Im Bild 3.17 c ist das Schema eines Schneckengetriebes dargestellt. Die Schnecke ist 
als ein- oder mehrgängige Schraube ausgebildet (Gangzahl Zg). Das Übersetzungsver¬ 
hältnis ermittelt sich für die Zähnezahl z des Schneckenrads zu 



CUg ^ 


Das Verhältnis des theoretischen Abtriebsmoments zum Motormoment ist ebenfalls 
gleich dem Übersetzungsverhältnis. Werden voraussetzungsgemäß die (infolge der hohen 
Übersetzung meist vernachlässigbare) Massenträgheit des Getriebes dem kinematischen 
System und die Reibungseinflüsse dem Motor zugeschlagen, so kann für das Modell des 
Übersetzungsgetriebes allgemein 

Mq = iiMf^ 

(3.44) 

angesetzt werden (Bild 3.17d). 

In den Bildern 3.18a und b sind die Schemata üblicher Umsetzungsgetriebe abgebildet. 
Für ihren Umsetzungsfaktor (2 sind die entsprechenden Beziehungen einfach aus diesen 
Bildern zu entnehmen. 
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Für den Schraubtrieb gilt 

. _ _ Fg _ ^TT 

^G h 

h Gewindesteigung je Umdrehung. 


(3.45 a) 


Für Ritzel-Zahnstange gilt 

. Wg -^g 2 



do Teilkreisdurchmesser des Ritzels 
m Zahnmodul 
z Zähnezahl des Ritzels. 



2 

5 

WZ 


(3.45 b) 



Bild 3.18. Umsetzungsgetriebe von Rotation auf Translation 

di), b) Wirkungsschema eines Schraubtriebs und einer Ritzel-Zahnstange-Paarung; c) Übertragungsverhalten eines 
Umsetzungsgetriebes 


Im Bild 3.18c ist wiederum das Übertragungsverhalten dargestellt (Massenträgheits¬ 
und Reibungseinflüsse ebenfalls dem Motor zugeschlagen) : 


Fg — ii^G 

(Dq — ^ 2 % • 


(3.46) 


3.3.2.3. Übertragungsverhalten und Kennwerte des elektrischen Antriebs 

Die für die drei Bestandteile des Antriebs abgeleiteten Modelle sind im Bild 3.19 zum 
Signalflußbild des gesamten Antriebs zusammengefaßt worden. Ein Vergleich mit 
Bild 3.12a zeigt, daß die Struktur etwas einfacher ist: es existieren keine sich kreuzenden 
Rückwirkungen. 



R'-R^R,r3 


Bild 3.19. Detailliertes Signalflußbild 

der Funktionsgruppe Steller-Motor- Übersetzungsgetriebe-Umsetzungsgetriebe 
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Bei der Ermittlung der Übertragungsfunktionen SG(p)lu^ip) und Sg(p)IFiXp) soll zu¬ 
nächst wiederum die Reibkraft vernachlässigt werden. Auf das dann einschleifige Signal¬ 
flußbild ist Gl. (3.17) sofort anwendbar. 

Aus den Ansätzen 


und 


Sgip) 




1 -l- T^tP F' -f- L'p 




rriredP 


1 -h 
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R' -h L’p 
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mredP 


p 


Sg{p) 

Flip) 


1 _ 1 _ 

_ WredP P _ 

1 +-!- 

R + Lp m,^dP 


sind die Übertragungsfunktionen 

Sg(p) ^ Fsi _I_ 1 

u^(p) pK^^i^h] 1 -I- TmP(1 -i- T^p) 1 + TstP 

Sg{p) _ F + Rers _ 1 + F/^p _ 

FM ~ piKu^iM 1 + T’Xl -f np) 

Y’ _ ^ "F Lgrs _ F 

R + ~ R' 

, _ Wred {R + R ers ) _ /n,ed^' 

J \l — - — - 


(3.47) 

(3.48) 

(3.49) 

(3.50) 


zu ermitteln. Ein Vergleich mit den ähnlichen Beziehungen des Motors allein [s. Gin. (3.38) 
bis (3.41)] zeigt, daß die Ankerzeitkonstante ^om Steller nur wenig beeinflußt wird, 
daß sich aber die elektromechanische Zeitkonstante durch das Getriebe sehr stark ver¬ 
ringern kann. Das trifft auch auf die statischen Übertragungsfaktoren zu. Günstig ist 
dies bei der Rückwirkung der äußeren Kräfte; ungünstig ist die relativ geringe erreich¬ 
bare Stellgeschwindigkeit Sq , die sich bei großen Übersetzungsverhältnissen , «2 ergibt. 

Nicht so einfach zu überschauende Zusammenhänge existieren bei der Berücksichti¬ 
gung der Reibung. Ist das Reibmoment eine nichtlineare Funktion der Winkel¬ 
geschwindigkeit cüM, wie im entsprechenden Block des Signalflußbilds angedeutet, kön¬ 
nen die Grund- und Bilanzgleichungen nur so weit zusammengefaßt werden, daß 
und Mr noch explizit enthalten sind. Genügt die Berücksichtigung der geschwindigkeits¬ 
proportionalen Reibung (Mr = ä:com), so können wiederum Übertragungsfunktionen 
errechnet werden. 

Wird Bild 3.19 in Bild 3.20 umgezeichnet, dann sind innere und äußere Schleife sofort 
erkennbar. Die innere Schleife ist mittels (3.17) in die Zwischenfunktion G^J^p) überzu¬ 
führen 

1 


Gü^ip) 




1 H- 

mr^dP 


_ 1 _ 

(/\'' 2 )^ k + m,^iP 
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Danach sind die Ansätze für die gesuchten Übertragungsfunktionen denen zu (3.47) und 
(3.48) ähnlich. Es muß lediglich die Funktion l/(AWred/^) durch die Zwischenfunktion 
GiiJjf) ersetzt werden. 



Bild 3.20. Linearisiertes und umgeformtes Signalflußbild des elektrischen Antriebs 


Es ergeben sich infolge k #= 0 nach den entsprechenden Umrechnungen kompliziertere 
Ausdrücke. Vor allem geht die eindeutige Zuordnung der Parameter zur Anker- und zur 
elektromechanischen Zeitkonstante verloren. Die Übertragungsfunktionen lauten jetzt 


soip) _ Ku 1 _ 1 

Me(p) P 1 + TiP + T\p^ 1 + JstP 

Sg{p) ^ -Kp 1 + Tjp 
FiXp) P 1 + Fip + tIp^ 

“ “ ilil iKu0^ + R'k) 


i\il (K^0^ + R'k) 

j ^ + L'ki\il 

' i\i\ iK^0^ + R'k) 

j2 ^ 

" ili, {K^0^ + R'k) 


(3.51) 

(3.52) 


sowie Tst gemäß (3.42) und gemäß (3,51). 

Daß die Reibung bei vorhandenem Getriebe eine große Rolle spielen kann, zeigt der 
Term L'ki\il in der Zeitkonstante T^, die die Dämpfung des Systems beeinflußt [siehe 
Gl. (3.18): Ti = 2DT\. 

Es sei noch darauf hingewiesen, daß die Übertragungsfunktionen auch gelten, wenn 
nur eines der beiden Getriebe eingesetzt werden muß. Bei fehlendem Übersetzungsgetriebe 
wird zu = 1. Wird nur das Übersetzungsgetriebe verwendet, so fällt aus diesen 
Gleichungen (2 heraus, und es werden der Weg Sq zum Winkel q )^, die Belastungskraft Fl 
zum Belastungsmoment Mi^ und die reduzierte Masse zum reduzierten Massenträg¬ 
heitsmoment /red • 








62 


3. Kinematische Systeme, Antriebe und Meßsysteme 


3.3.3. In Lageregelungen eingesetzte pneumatische Antriebe 

Praktische Bedeutung haben zwei Konzeptionen erlangt: 

- der elektropneumatische Antrieb und 

- der pneumatische Antrieb mit elektrischer Bremse. 


Elektropneumatischer Antrieb 

Es besteht eine sehr große Analogie zum ausführlich beschriebenen elektrohydraulischen 
Antrieb: ein dem Servoventil ähnliches Ventil, elektrisch ansteuerbar, dosiert den Luft¬ 
strom zu einem rotatorischen Verbraucher. Zwei wesentliche Unterschiede zwischen 
Pneumatik und Hydraulik erfordern jedoch für diesen Antrieb zusätzliche Maßnahmen: 

1. Luft ist viel stärker kompressibel als öl. 

2. Vor allem wegen dieser Kompressibilität sind aus Sicherheitsgründen nur Druck¬ 
quellendrücke bis zu 1 MPa möglich. 

Um trotzdem eine ausreichend kleine Eigenzeitkonstante T [s. Gl. (3.21)] bei gleich¬ 
zeitig ausreichend großem Stellmoment zu erzeugen, sind ein Getriebe mit sehr hoher 
Übersetzung und eine extrem kleine Ventil-Verbraucher-Einheit nötig. 

Ein günstiger Verbraucher ist in diesem Fall eine Turbine mit sehr kleinem Verdrän¬ 
gungsvolumen Fg, an deren Gehäuse das Steuerventil angeflanscht ist. Als Getriebe 
kommen meist Zahnriementriebe in mehreren Stufen zum Einsatz. Damit ist ein Über¬ 
setzungsverhältnis bis etwa 10^ zu erreichen. Im Bild 3.21 a ist das Schema eines solchen 
Antriebs dargestellt, im Bild 3.21b ein aus den Bildern 3.12a und 3.19 (Getriebe) ab¬ 
geleitetes Signalflußbild. 



Bild 3.21. Elektropneumatischer Antrieb 

a) Schema; b) linearisiertes und vereinfachtes Signalflußbild 


Der Einfachheit halber wurden für den folgenden qualitativen Vergleich der Leckleit¬ 
wert (Gl) und die geschwindigkeitsproportionale Reibung {k) vernachlässigt. 

Wird dieses Signalflußbild mit dem im Bild 3.12 a verglichen, so ist zu erkennen, daß 
der elektropneumatische Antrieb ähnliches dynamisches Verhalten wie der elektro¬ 
hydraulische erreicht 

- wenn das Produkt aus VJ^ viel größer als das geometrische Verdrängungsvolumen Fg 
eines hydraulischen Verbrauchers ist, um die wesentlich kleinere Druckverstärkung Eq 
auszugleichen, und 

- wenn die wesentlich größere Kompressibilität von Luft durch ausreichend kleines Vo¬ 
lumen V kompensiert wird. 
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Pneumatischer Antrieb mit elektrischer Bremse 

Diese Speziallösung [3.6] soll nicht ausführlich mathematisch beschrieben werden, da ihr 
Modell erheblich von anderen abweicht. Der Pneumatikzylinder wird von einem einfachen 
Zwei- oder Dreipunktstellglied angesteuert und gibt die Bewegungsrichtung des Antriebs 
vor. Diese Aufgabe hat im elektrischen Antrieb die Umkehrschaltung des Stellglieds. 
Eine Bremse erzeugt eine Kraft, die der Bewegung immer entgegengesetzt ist. Die An¬ 
steuerschaltung der Bremse realisiert die Aufgabe des Stromrichters im Stellglied des 
elektrischen Antriebs. Die vom Antrieb erzeugte Gesamtstellkraft ist im stationären Be¬ 
trieb immer die Differenz der Druck- und der Bremskraft. 

Es müssen beide Stellglieder im Signalfluß des Lageregelkreises liegen. Das dynami¬ 
sche Verhalten in der Nähe der Regelabweichung Null ist schwer beschreib- und be¬ 
herrschbar. 

3.3.4. Elektrische Schrittantriebe 

Diese Antriebe nehmen gegenüber allen bisher beschriebenen eine Sonderstellung ein. In 
ihnen werden diskrete Eingangssignale in diskrete Weg- oder Winkelelemente umgesetzt. 
Bei Beachtung der Grenzen des dynamischen Verhaltens sind Positionen bei reiner 
Steuerung (keine Wegmessung, keine Anschläge, Endschalter usw.) exakt und frei- 
programmierbar zu realisieren. 

Sie werden mit elektrischen Impulsen angesteuert. Der Drehwinkel ist proportional 
der Pulszahl Z; 

(p = A 9 ?Z; IScp Schrittwinkel. 

Das Wirkprinzip besteht darin, daß eine Vorzugsrichtung des magnetischen Feldes des 
Ständers aufgebaut wird, die schrittweise wandert. Die technischen Realisierungen sind 
vielgestaltig (Mehrphasenstator oder Mehrstatorenausführungen in Verbindung mit 
unterschiedlichen Rotorprinzipien). Ihr Einsatz in der Industrierobotertechnik ist nur 
begrenzt möglich, da leicht Schrittfehler auftreten können, die infolge fehlender Lage¬ 
messung nicht wieder kompensiert werden. 

Schrittverluste treten auf, wenn Schrittfrequenz und auf den Motor bezogenes Gegen¬ 
moment infolge äußerer Kräfte oder auch Massenwirkungen nicht exakt aufeinander ab¬ 
gestimmt sind. 

Eine Modellierung im bisherigen Sinne ist nicht möglich und nicht notwendig. In der 
Bewegungssteuerung müssen die zulässigen Pulszahlen je Zeiteinheit berücksichtigt wer¬ 
den. Sie sind in der Start- und in der Bremsphase niedriger als bei stationärer Ge¬ 
schwindigkeit. 

3.3.5. Einfachantriebe 

Als Einfachantriebe sollen Antriebe gelten, die nicht in Lageregelungen eingesetzt wer¬ 
den und ein relativ einfaches Stellglied besitzen. Es kommen vor allem wegeventil¬ 
gesteuerte pneumatische und hydraulische Antriebe zum Einsatz. Elektrische Einfach¬ 
antriebe sind in der Handhabetechnik aus technisch-ökonomischen Gründen selten. 

Die Wegeventile haben Zwei- oder Dreipunktverhalten zur Realisierung von Rechts¬ 
lauf, Linkslauf und ggf. Halt. Letzteres ist dann nötig, wenn nicht gegen Anschläge ge¬ 
fahren, sondern z. B. mit Hilfe von Endschaltern auf Stillstand geschaltet wird. Ist Vor¬ 
abschaltung auf niedrige Geschwindigkeit notwendig, sind zwei weitere Schaltzustände 
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nötig. Das wird durch zusätzliche Wege- und Drosselventile realisiert. Die Modellierung 
dieser Antriebe im Sinne einer optimalen Auslegung der Bewegungssteuerung reduziert 
sich im wesentlichen auf die Ermittlung von Verfahrzeiten zwischen den Positionen. 
Diese werden überwiegend experimentell ermittelt. 


3.4. Meßsysteme 
3.4.1. Aufgaben 

Die automatische Steuerung eines technischen Systems erfordert die Erfassung von 
momentanen Zustandsparametern, wenn diese aufgrund unzureichender A-priori- 
Kenntnisse oder aus Aufwandsgründen nicht in dem der Steuerung zugrunde liegenden 
Modell mit ausreichender Genauigkeit enthalten sind. Dies geschieht mittels geeigneter 
Meßsysteme oder Sensoren. 

In der klassischen Meßtechnik ist das Ergebnis der Messung ein Zahlenwert, der die 
Meßgröße als Vielfaches einer geeignet gewählten Einheit charakterisiert. Die gesuchte, 
i.allg. nichtelektrische Größe wird durch Ausnutzung unterschiedlicher physikalischer 
Effekte in ein elektrisches Signal gewandelt, zweckentsprechend vorverarbeitet und aus¬ 
gegeben (Bild 3.22). Die Vorverarbeitung dient der Eliminierung von Störungen, Kom¬ 
pensation unerwünschter Wandlereigenschaften und Verstärkung des elektrischen Ab¬ 
bildsignals. Zur Übertragung und Anpassung an das Steuerungssystem können weitere 
Signalwandlungen vorgenommen werden. Diese Form der Informationsgewinnung ist 
nur geeignet, wenn der gesuchte Prozeßparameter der direkten Messung zugänglich, d.h. 
über einen geeigneten Meßwandler erfaßbar ist. Mit zunehmender Komplexität der 
Steuerungsaufgabe werden Informationen über Prozeßzustände benötigt, die nicht direkt 
gemessen werden können und in der Regel aus einer Vielzahl von Einzelmessungen abge¬ 
leitet werden. Eine für die Robotertechnik typische Aufgabe ist die Erkennung eines im 
Arbeitsraum befindlichen Werkstücks. Die Steuerungsaufgabe besteht darin, N unter¬ 
schiedliche Teile an ebenso vielen unterschiedlichen Ablageplätzen zu stapeln. 


Meßgröße 


► 



natürliches elektrisches 

Abbildsignal Abbildsignal 


Bild 3.22. Grundschema einer Meßkette 


Meßgröße 



elektrisches Abbildsignal mit 

Abbildsignal Informationsverdichtung 


Bild 3.23. Schema eines Sensorsystems 


Der Ausgang des Meß- oder Sensorsystems muß also je nach Art des Teiles N unter¬ 
schiedliche Ausgangssignale liefern. Kommt als Wandler eine Kamera zum Einsatz, so 
liefert diese ein zweidimensionales elektrisches Abbild des Werkstücks. Zur Erzeugung der 
N Ausgangssignale muß daher die Meßkette in der im Bild 3.23 gezeigten Weise erweitert 
werden. Anhand von Modellabbildungen der N Werkstücke wird durch einen Vergleich 
die Übereinstimmung mit dem erfaßten Bild ermittelt und bei minimaler Abweichung 
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eine Entscheidung über die Zugehörigkeit des Werkstücks zu einer der N Klassen ge¬ 
troffen. 

Für die Steuerung von Robotern benötigte Informationen sind die Zustandsparameter 
des mechanischen Systems und Parameter aus der technologischen Umwelt, mit der der 
Roboter in Wechselwirkung tritt. 

Sensoren zur Bestimmung des momentanen Roboterzustands (Position und Geschwin¬ 
digkeit der Achsen, Kräfte in den Gelenken usw.) werden häufig als „innere Sensoren“, 
Sensoren zur Erfassung des Umweltzustands als „äußere Sensoren“ bezeichnet. Ein 
Grenzfall tritt auf, wenn beispielsweise durch Kraftsensoren im Roboterarm sowohl 
Schwerkräfte und dynamische Kräfte des mechanischen Systems als auch durch den 
technologischen Prozeß bedingte Wechselwirkungskräfte mit der Umwelt erfaßt werden. 
Äußere Sensoren werden im Abschnitt 7. ausführlich beschrieben. 

Allgemeine Probleme zur Auslegung von Meßsystemen und Eigenschaften von Wand¬ 
lern sowie die Wirkprinzipien der am häufigsten eingesetzten inneren Sensoren werden 
nachfolgend erläutert. Auf nicht roboterspezifische Sensoren zur Kontrolle des inneren 
Betriebszustands, wie Druck, Temperatur, Verschleiß usw., wird an dieser Stelle nicht 
eingegangen. 

Die Begriffe Meßwandler, Meßsystem, Sensor, Sensorsystem werden in der Fach¬ 
literatur nicht einheitlich benutzt, da durch zunehmende räumliche und funktionelle 
Integration der Verarbeitungsstufen gemäß den Bildern 3.22 und 3.23 die Grenzen häufig 
nicht mehr erkennbar sind. 

Nachfolgend werden deshalb neben dem Begriff des eigentlichen Meßwandlers die Be¬ 
griffe Sensor, Meß- oder Sensorsystem für eine Einrichtung benutzt, die die zur Steuerung 
benötigten Ausgangssighale entsprechend den Bildern 3.22 und 3.23 liefert. 

3.4.2. Probleme der Meßsignalgewiimung 

Besondere Anforderungen an die Meßtechnik in Verbindung mit der Robotersteuerung 
resultieren aus der unmittelbaren Kopplung an den technologischen Prozeß und der da¬ 
mit verbundenen Zielstellung, Erzeugnisse gewünschter Menge und Qualität zu produ¬ 
zieren. Das erfordert die Beachtung solcher Parameter wie 

- Zuverlässigkeit bei Einsatz unter rauhen Umgebungsbedingungen 

- Meßbereich, Meßgenauigkeit und Langzeitkonstanz 

- Reproduzierbarkeit der Meßwerte 

- Störsicherheit, fehlerfreie Meßwertübertragung 

- Dynamik, sofortige Verarbeitung der Information. 

Meßgrößenwandlung zur analogen und diskreten Informationsgewinnung 

Die in den meisten Fällen nichtelektrische, analoge Meßgröße ist zum Zweck der Über¬ 
tragung sowie der Weiterverarbeitung im Prozessor auf ein von diesem verarbeitbares, 
digitales elektrisches Signal abzubilden. Die Wandlung des Signals innerhalb der im 
Bild 3.22 dargestellten Meßkette erfolgt i.allg. in mehreren Schritten, wobei die Meß¬ 
größe zunächst auf einen analogen elektrischen Informationsparameter abgebildet wird, 
z. B. Amplitude, Frequenz oder Phasenlage einer Spannung. 

Je nach dem Wertevorrat am Ausgang der Meßkette unterscheidet man analoge und 
diskrete Signale. Im folgenden wird an Beispielen der Signalfluß in der Meßkette demon¬ 
striert. Die sich daraus ergebenden Konsequenzen für das dynamische Verhalten werden 
anschließend betrachtet. 


5 Industrierobotersteuerung 
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Bild 3.24 zeigt den Signalfluß in einem Kraftmeßumformer mit analoger Informations¬ 
gewinnung. Die Kraftänderung wird im Meßfühler in eine Wegänderung (Formänderung 
eines deformierbaren Körpers) umgewandelt. Mittels Dehnungsmeßstreifen, die auf dem 
elastischen Körper befestigt sind, wird eine der Wegänderung proportionale Widerstands¬ 
änderung realisiert. Die Dehnungsmeßstreifen sind in einer Brückenschaltung ange¬ 
ordnet. Mit einer Trägerfrequenzmeßeinrichtung wird die Widerstandsänderung auf eine 
zugeordnete Spannungsänderung abgebildet, die als analoges elektrisches Ausgangssignal 
den Meßwert darstellt. Die Umsetzung in ein rechnerkompatibles digitales Signal erfolgt 
in einem nachzuschaltenden Analog-Digital-Umsetzer. 


1. Wandler 2. Wandler 3. Wandler 


Meßgröße 
(Kraft) ^ 



natürliches 

Abbildsignal 

(Weg) 


elektrisches 

Abbildsignal 

(Widerstand) 


elektrisches 

Abbildsignal 

(Spannung) 


Bild 3.24. Signalfluß in einer Meßkette mit analoger Meßwertausgabe 


1. Wandler 2. Wandler 3. Wandler 4. Wandler 


Meßgröße 
(Kraft) ' 


Meßfühler [-► 

A 


Kondensator Oszillator 
-1 A - ' A 


Tor/Zähler !-► 


Speicher 


Meßwert 


natürliches elektrisches elektrisches elektrisches Abbildsignal 

(Weg) (Kapazität) (Frequenz) (binär kodiertes Signal) 


Bild 3.25. Meßkette für die Messung einer Kraft mit digitaler Meßwertausgabe 


Eine Meßkette für diskrete Informationsgewinnung, ebenfalls für die Kraft als Ein¬ 
gangsgröße, wird im Bild 3.25 gezeigt. Die Kraftänderung bewirkt die Lageänderung der 
Platte eines Kondensators, der frequenzbestimmendes Element eines elektrischen Schwing¬ 
kreises ist. In diesem Fall ist die Oszillatorfrequenz ein analoges Abbildsignal der Kraft. 
Frequenzanaloge Meßverfahren sind besonders „digitalfreundlich“. Der letzte Wandler 
in der Meßkette setzt die Frequenz unmittelbar in ein digitales Ausgangssignal um. Dazu 
wird während einer definierten Meßzeit die Zahl der Perioden des Abbildsignals in einen 
Binärzähler eingezählt. Am Ausgang des Zählers steht nach Ablauf der Meßzeit der 
kodierte, digitale Meßwert an und kann bis zur Bereitstellung des folgenden Meßwerts in 
einen Speicher übernommen werden. 

Eine andere Möglichkeit zur Digitalisierung besteht darin, während einer Periode des 
frequenzanalogen Signals (oder während einer konstanten Anzahl von Perioden) eine 
Torschaltung zu öffnen und während dieser Zeit Taktimpulse konstanter Folgefrequenz 
in einem Zähler zu addieren. 

Der Umsetzfehler F ergibt sich in beiden betrachteten Varianten zu 

F=(jrT)-K (3.53) 

Dabei kennzeichnet / die zu bestimmende Frequenz und T die definierte Meßzeit bzw. / 
die Folgefrequenz der Taktimpulse und T die Periodendauer des frequenzanalogen 
Signals (Toröffnungszeit). Soll der Meßfehler l®/oo nicht übersteigen, so sind mindestens 
10^ Impulse je Messung einzuzählen. Entsprechend groß muß die definierte Meßzeit ge¬ 
wählt werden bzw. entsprechend hoch die Folgefrequenz der Taktimpulse. Die tech- 
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nische Realisierbarkeit wird die Wahl der einen oder anderen Methode bestimmen [3.11]. 
An analoge Baugruppen einer Meßkette mit digitaler Meßwertausgabe werden hohe 
Anforderungen hinsichtlich Meßbereichsdynamik und Konstanz gestellt, wenn die hohe 
erreichbare Auflösung digitaler Verfahren genutzt werden soll. Deshalb sind Meßketten 
anzustreben, in denen die Signalverarbeitung ausschließlich digital erfolgt. Dazu muß 
bereits im Meßfühler die Meßgröße auf ein diskretes, ggf. auch kodiertes elektrisches 
Signal abgebildet werden, oder die Meßgröße selbst liegt bereits quantisiert vor. Solche 
Meßketten lassen sich in relativ wenigen Fällen realisieren. Ein Beispiel ist der kodierte 
Längenmaßstab. 


Dynamische Eigenschaften von Wandlern 

Das dynamische Übertragungsverhalten der Funktionsgruppen einer Meßkette hat 
wesentlichen Einfluß auf die Realisierbarkeit einer zeitoptimalen Robotersteuerung. Der 
Zeitverlauf der Meßgröße soll auch bei schnellen Bewegungsabläufen am Ausgang der 
Meßkette möglichst unverfälscht auf den elektrischen Signalparameter abgebildet 
werden. 



a) t 



Bild 3.26 

Signalarten, untergliedert 
nach dem Zeitverlauf und 
dem Wertevorrat 

a) kontinuierlich 

b) diskontinuierlich 

-analog; 

-diskret 


Nach dem Zeitverlauf des Informationsparameters am Meßkettenausgang unter¬ 
scheidet man zeitkontinuierliche und zeitdiskrete Signale (Bild 3.26). Dynamische Eigen¬ 
schaften von Meßsystemen werden damit jedoch nicht hinreichend charakterisiert. Dazu 
die Betrachtung folgender Beispiele: 

Die im Bild 3.24 skizzierte Meßkette liefert ein analoges, zeitkontinuierliches Ausgangs¬ 
signal. Bei einer Trägerfrequenzbrückenspannung von 5 kHz wird die Grenzfrequenz für 
dieses Meßsystem, bedingt durch das erforderliche Tiefpaßglied zum Ausfiltern des 
5-kHz-Trägers, etwa 1 kHz betragen (Bild 3.27). Daraus resultiert für das Meßsystem 
eine Eigenzeitkonstante T in der Größenordnung von 1 ms. Bei einer sprunghaften Weg¬ 
änderung ist prinzipiell erst nach Ablauf einer vollen Periode Tf der Trägerfrequenz- 



Bild 3.27. Meßschaltung für eine Widerstandsbrücke mit Dehnungsmeßstreifen 

a) Blockschaltbild; b) Übertragungsverhalten 
K statischer Übertragungsfaktor 
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Spannung eine Amplitudenbestimmung ausführbar. Das regelungstechnische Über¬ 
tragungsverhalten wird demnach näherungsweise durch ein Laufzeitglied mit Ver¬ 
zögerung bestimmt (Bild 3.27b). Hinzu kommt schließlich eine weitere Verzögerung, die 
von der Umsetzzeit des nachzuschaltenden Analog-Digital-Umsetzers bestimmt wird. 

Die im Bild 3.25 dargestellte Meßkette liefert ein digitales, zeitdiskretes Ausgangs¬ 
signal. Die dynamischen Eigenschaften dieser Meßanordnung werden von der technisch 
realisierbaren Möglichkeit der Umsetzung der Oszillatorfrequenz in ein digitales, kodier¬ 
tes Ausgangssignal bei Einhaltung des zulässigen Fehlers bestimmt. Die Umsetzung der 
Frequenz / in eine digitale Ausgangsgröße kann über die Bestimmung der Perioden¬ 
dauer Tf durch Auszählen der Zahl der Taktimpulse einer konstanten Impulsfolge¬ 
frequenz fo während einer Periode erfolgen (Bild 3.28). Bei einem zulässigen Fehler von 
l®/oo muß für die Folgefrequenz der Taktimpulse fo ^ lOy erfüllt sein. Liegt die Fre¬ 
quenz /in der Größenordnung 1 MHz, so könnte zwar in Zeitabständen von 2 [as jeweils 
ein neuer Meßwert bereitgestellt werden, jedoch ist die technische Realisierbarkeit eines 
einfachen Meßsystems bei einer Taktfolgefrequenz von 1 GHz problematisch. 
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Das Auszählen der Periodenzahl während einer definierten Zeit erfordert beim vor¬ 
gegebenen Fehler eine Meßzeit von 1 ms. Nach Ablauf dieses Zeitintervalls kann jeweils 
ein neuer Meßwert am Ausgang der Meßkette abgefragt werden. 

Schwingt dagegen der Oszillator mit einer Frequenz in der Größenordnung von 1 kHz, 
so ist die im Bild 3.28 angegebene Variante mit einer Taktfolgefrequenz von/o = 1 MHz 
realisierbar. Da für die Bildung eines Meßwerts mindestens eine Periode der Oszillator¬ 
frequenz erforderlich ist, ergibt sich für den zeitlichen Abstand zwischen zwei Messun¬ 
gen wiederum ä; 1 ms. Bei schnellen Bewegungsabläufen wird über Veränderungen 
im System während der Zeit 7^ keine Information an die Steuerung gegeben. Das Über¬ 
tragungsverhalten der Meßkette kann näherungsweise durch ein Laufzeitglied mit der 
Laufzeit 7/ = TJ2 beschrieben werden. 

3.4.3. Weg- und Winkelmessung 
3.4.3.1. Allgemeine Probleme 

Positioniermeßsysteme haben bei der Programmierung des Roboters die aktuellen 
digitalen Meßsignale, die dem jeweiligen Ort zugeordnet sind, für die Abspeicherung als 
Sollwerte bereitzustellen. Bei der Programmwiedergabe verarbeitet die Steuerung die 
Meßwertsignale, um aus dem Sollwert-Istwert-Vergleich Steuerbefehle abzuleiten. 
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Bei ausschließlicher Teach-in-Programmierung sind erreichbare Auflösung und Re¬ 
produzierbarkeit der Meßwerte entscheidend für die Positioniergenauigkeit. Ist hingegen 
auch textuelle Programmierung vorgesehen, dann sind zusätzlich an die Genauigkeit bzw. 
Linearität des Meßsystems gleich hohe Anforderungen wie an die Auflösung zu stellen. 
Im diskreten Bereich ist eine Linearisierung hardwaremäßig mittels programmierbarer 
Speicher möglich. Die gemessenen Werte werden dann vom Ausgang der Meßkette nicht 
unmittelbar der Steuerung zugeführt, sondern sie stellen die Adressen für einen Speicher¬ 
baustein dar, in dem die zugeordneten linearisierten Meßwerte abgelegt sind. Diese 
Speicher stellen die Ausgabeeinheit der Meßkette dar. Der Speicheraufwand kann, ab¬ 
hängig vom Meßbereich und der erforderlichen Auflösung, sehr hoch sein; die Lineari¬ 
sierung erfolgt aber praktisch ohne zeitliche Verzögerung, 

Eine softwaremäßige Linearisierung mittels Mikrorechner auf der Grundlage der 
analytischen Beschreibung der Wandlerkennlinie ist zwar bei wesentlich geringerem 
Speicherbedarf realisierbar, jedoch ist diese Lösung für eine Robotersteuerung zu zeit¬ 
aufwendig, um mit verfügbaren Mikrorechnern bei schnellen Bewegungsabläufen im 
Echtzeitbetrieb arbeiten zu können. 

In Abhängigkeit von der Art der Ankopplung der Meßwertaufnehmer an die Bewe¬ 
gungseinheiten des Roboters ist zwischen direkter und indirekter Positionsbestimmung zu 
unterscheiden. Eine translatorische Bewegung wird direkt erfaßt, wenn der bewegliche 
Teil eines translatorischen Meßwertaufnehmers starr mit der zu positionierenden Be¬ 
wegungsgruppe verbunden ist. Wird hingegen die Lage der zu bewegenden mechanischen 
Baugruppe über bewegliche Elemente auf ein translatorisches Meßsystem oder über 
Zahnstange-Ritzel, Zahnriemen, Umlenkrolle oder Spindel auf einen rotatorischen Auf¬ 
nehmer übertragen, so liegt eine indirekte Messung vor. Spiele in den Verbindungsglie¬ 
dern sowie Deformationen zwischen der zu positionierenden Baugruppe und dem Ort der 
Meßwertaufnahme führen zu unkontrollierbaren Meßfehlern und verschlechtern die 
Reproduzierbarkeit der Positionierung. Dennoch überwiegt in der Praxis die indirekte 
Weg- oder Winkelmessung aufgrund der in der Regel einfacheren konstruktiven Anbau¬ 
bedingungen, insbesondere für rotatorische Meßwertaufnehmer. 

Nach dem Meßverfahren ist zwischen und inkrementalen Verfahren zu unter¬ 

scheiden. Bei absolut arbeitenden Verfahren wird der Istwert eindeutig auf den Signal¬ 
parameter am Ausgang der Meßkette abgebildet. Der Istwert ist dabei auf einen festen 
Referenzpunkt der jeweiligen Achse bezogen. 

Äußere Störeinflüsse oder Ausfall der Stromversorgung bewirken keine bleibende Be¬ 
einflussung des Meßwerts. Kurzzeitige Fehler, beispielsweise durch Einkopplung von 
Störsignalen verursacht, werden nicht verschleppt. 

Bei den inkrementalen Verfahren wird der Istwert durch Aufzählen von Weg- oder 
Winkelinkrementen von einem Anfangswert aus gebildet. Die Inkremente werden von der 
Meßverkörperung im Meßwertaufnehmer vorgegeben. Der Anfangswert ist bei jeder 
Inbetriebnahme der Meßeinrichtung durch Anfahren einer definierten Anfangsposition 
neu festzulegen (Nullung). Bei Ausfall der Stromversorgung geht die Information ver¬ 
loren, Äußere Störeinflüsse können zu Fehlerinkrementen im Vorwärts-Rückwärts- 
Zähler führen, die erst bei einer erneuten Nullung korrigiert werden. Um dem Verschlep¬ 
pen von Fehlerinkrementen entgegenzuwirken, bringen Hersteller inkremental arbeiten¬ 
der Meßwertaufnehmer mitunter in bestimmten Weg- bzw. Winkelabständen Referenz¬ 
marken an, die eine Korrektur von Fehlern beim Überfahren dieser Marken während der 
Messung ermöglichen (Bild 3.29). 

Obwohl die absoluten Verfahren dem Erfordernis der Verarbeitung der absoluten 
Information in der Steuerung entgegenkommen, werden inkrementale Verfahren in der 
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Praxis häufiger angewendet. Die Gründe hierfür sind im einfacheren Aufbau, der gerin¬ 
geren Masse, des niedrigeren Preises inkrementaler Aufnehmer zu sehen sowie darin, daß 
der Meßbereich vom Meßgrößenaufnehmer nicht prinzipiell begrenzt wird und daß mit 
modernen elektronischen Auswerteverfahren eine weitgehende Störimpulsunterdrückung 
und damit eine hohe Zuverlässigkeit gewährleistet werden kann. 



Bild 3.29 

Inkrementaler Längenmaßstab mit Referenzmarke 

I Inkrementteilung; 2 Referenzmarke 


Eine Zwischenstellung nehmen die zyklisch-absoluten Meßverfahren ein. Weit ver¬ 
breitet sind phasenzyklische Systeme. Hinsichtlich der Gesamtmeßeinrichtung handelt 
es sich um inkremental arbeitende Wandler mit relativ großen Weg- bzw. Winkel¬ 
schritten, z.B. 0,5 bis 10 mm bei der Wegmessung, 1 bis 360° bei der Winkelmessung. 
Innerhalb einer Schrittweite wird die Meßgröße analog interpoliert und absolut auf den 
elektrischen Signalparameter abgebildet. Zur exakten Nullung des Systems braucht eine 
Referenzposition nur grob - innerhalb der vorgegebenen Schrittweite - angefahren zu 
werden und nicht, wie bei rein inkremental arbeitenden Systemen, exakt auf die Referenz¬ 
position. 

Funktionsweise und Eigenschaften einiger ausgewählter Wandler sollen dargestellt 
werden; auf dynamische Eigenschaften, die sich auf die Steuerung auswirken, wird hin¬ 
gewiesen. 

3.4.3.2. Absolute Meßverfahren 
Binäre Positionsgeber 

Mit binären Positionsgebern sind meßtechnische Aufgaben mit geringem Schwierigkeits¬ 
grad lösbar. Binäre Positionsgeber stellen keine Meßsysteme im eigentlichen Sinne dar. 
Sie liefern keine ständige Information über die Position, sondern signalisieren lediglich 
das Erreichen einer bestimmten Position, die Anwesenheit oder Nichtanwesenheit eines 
Werkstücks an einem definierten Ort. Die bereitgestellten Meßwerte können nicht die 
Basis einer kontinuierlichen Steuerung des Prozeßablaufs sein. Verschiedene Ausfüh¬ 
rungsformen sind bekannt, z.B. elektromechanische Schalter, induktive und kapazitive 
Schlitz- und Näherungsinitiatoren, Lichtschranken mit sichtbarem Licht oder Infrarot- 
licht bzw. auf der Basis der Kernstrahlung, Ultraschallinitiatoren. 

Potentiometer 

Präzisionspotentiometer werden als Weg- und Winkelgeber verwendet. Zwischen der 
Meßgröße s (Weg bzw. Winkel) und der Spannung U^, die am Potentiometerschleifer 
abgegriffen wird, besteht ein linearer Zusammenhang (Bild 3.30). Der Meßfehler liegt 
in der Größenordnung 10“^ des Meßbereichs. Er wird durch die endliche Schleiferbreite, 
die Inhomogenität des Kunststoffschicht-Widerstandselements bzw. durch den Win¬ 
dungssprung bei Drahtpotentiometern bedingt. Potentiometer werden für Meßbereiche 
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bis 900 mm bei translatorischem und bis zu 20 Umdrehungen bei rotatorischem Aufbau 
angeboten. Der Meßwert ist eine analoge Spannung; ein Analog-Digital-Umsetzer muß 
nachgeschaltet werden. Letzterer bestimmt die erreichbare Meßwertfolge, die im ms- bis 
f;LS-Bereich liegen kann. 
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Bild 3.30 

Potentiometer als Weggeber 

a) Wirkprinzip; b) Übertragungsverhalten 
K Übertragungsfaktor 


Potentiometer sind einfach im Aufbau und ermöglichen bei Verwendung schneller 
Analog-Digital-Umsetzer eine hohe dynamische Auflösung. Die nicht berührungslose, 
mit Materialverschleiß verbundene Meßwertabnahme ist jedoch ein entscheidender Nach¬ 
teil. Daraus resultieren zusätzliche Meßfehler durch sich zeitlich ändernde Übergangs¬ 
widerstände und Störanfälligkeit bei hohen Beschleunigungen infolge Prellerscheinungen 
am Schleifer.. Letzteres kann bei der Analog-Digital-Umsetzung große Fehler verur¬ 
sachen. 


Kodierte Längen- und Winkelmaßstäbe 

Kodelineale und Kodescheiben mit zumeist fotoelektrischem Meßwertabgriff sind Meß¬ 
wertaufnehmer, die die Meßgröße unmittelbar und nahezu verzögerungsfrei auf ein digi¬ 
tales, kodiertes, elektrisches Signal abbilden. Einschrittige Kodes, wie der Gray-Kode, 
werden bevorzugt verwendet [3.12] (Bild 3.31). Die einzelnen Spuren dieses Kodes sind 
zwar nicht bewertet, so daß eine nachträgliche Kodeumsetzung notwendig ist. Mehr- 
schrittige Kodes erfordern aber einen höheren Abtastaufwand, um die Eindeutigkeit des 
Meßwerts bei gleichzeitiger Änderung des Kodemusters in mehreren Spuren zu gewähr¬ 
leisten. Die dynamische Auflösung kann durch die dynamischen Parameter der Bau¬ 
elemente für die optisch-elektrische Meßwertumsetzung begrenzt sein. 



Bild 3.31 

Kodierter Längedtnaßstab mit einschrittigem Gray-Kode 


Kodelineale und -scheiben entsprechen aus steuerungstechnischer Sicht allen Forde¬ 
rungen, die an Meßwertaufnehmer für Robotersteuerungen gestellt werden. Bei üblicher¬ 
weise erforderlichen Meßbereichen und Auflösungen sind aber Kodemuster mit sehr 
vielen Spuren notwendig. Solche Umsetzer haben große Abmessungen und sind sehr 
teuer. Die Störanfälligkeit bei fotoelektrischem Meßwertabgriff und hoher Auflösung ist 
problematisch. Dies sind Gründe dafür, daß kodierte Längen- und Winkelmaßstäbe nicht 
in großem Umfang in der Handhabetechnik eingesetzt werden. 


3.4.3.3. Inkrementale Meßverfahren 

Beim inkrementalen Wegaufnehmer mit fotoelektrischem Meßwertabgriff ist auf einem 
Maßstabträger aus Stahl oder Glas über den gesamten Meßweg eine Gitterteilung kon¬ 
stanter Schrittweite in Form alternierend aufeinanderfolgender reflektierender und nicht- 
reflektierender Marken aufgebracht. Ein in geringem Abstand darüber in Meßrichtung 
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verschiebbarer Abtastkopf enthält vier Abtastfelder mit Gitterteilungen der gleichen 
Periode und den fotoelektrischen Wandlern. Die vier Gitterteilungen sind jeweils um ein 
Viertel ihrer Periode gegeneinander versetzt angeordnet. Damit ist eine Eliminierung des 
störenden Gleichanteils des Ausgangssignals möglich, und eine Entscheidung über die 
Zählrichtung des nachgeschalteten Vorwärts-Rückwärts-Zählers kann getroffen werden 
(Bild 3.32). Am Zählerausgang steht stets der aktuelle kodierte Meßwert unverzögert an. 

Die Auswertung kann in jedem der vier Abtastfelder des Abtastkopfs über eine große 
Gitterlinienzahl erfolgen; auch bei kleiner Gitterkonstante wird eine für die Messung hin¬ 
reichende Lichtintensität erreicht. Im Gegensatz dazu kann beim kodierten Längen¬ 
maßstab in der am höchsten auflösenden Spur nur eine Gitterteilung ausgewertet werden. 
Daraus resultiert die höhere mögliche Auflösung inkrementaler Verfahren. 




Meßgröße 

c) 


Meßwert 


Bild 3.32 

Inkrementale Wegmessung 

a) Abtastung der das Licht reflektierenden Marken 

b) Signaldiagramm der Fotoströme i'v der vier Wandler 

c) Übertragungsverhalten Fy fotoelektrische Wandler 


Der Erleichterung der fotoelektrischen Signalauswertung dient die Moirestreifen¬ 
technik. Durch schräge Anordnung der Gitter im Abtastkopf relativ zum Maßstab wird 
eine scheinbare Vergrößerung der Gitterabstände erreicht (Bild 3.33). Größere Hell- 
Dunkel-Zonen können ausgewertet werden, und es wird über viele Gitterlinien gemittelt. 


Bild 3.33 

Moirestreifenteclmik zur scheinbaren 
Vergrößerung der Gitterabstände 



Die maximale Verfahrgeschwindigkeit ist bei inkrementalen Verfahren begrenzt; sie 
wird durch die endliche Grenzfrequenz der eingesetzten fotoelektrischen Wandler be¬ 
stimmt. Von besonderer Bedeutung ist unter diesem Gesichtspunkt die störsichere Funk¬ 
tionsweise des Richtungsdiskriminators, wenn der Wandler hochfrequenten mechani¬ 
schen Erschütterungen ausgesetzt ist, da einmal eingezählte Fehlerimpulse bis zur näch¬ 
sten Nullung als Meßfehler verschleppt werden. 

Nach dem gleichen Prinzip arbeiten inkrementale Rundmeßsysteme. Maßstab und 
Abtastgitter sind dabei auf einer Kreisscheibe bzw. einem Kreissegment angeordnet. 
Solche Systeme werden mit 100 bis zu 36000 Linien/Umfang angeboten. Häufig wird 
eine elektronische Vervielfachung der binären Ausgangsimpulse zur Verbesserung der 
Auflösung angewendet. Auch Wandler mit elektromagnetischer Abtastung werden ver¬ 
wendet. 
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3.4.3.4. Phasenzyklische Meßverfahren 
Resolver 

Der zweipolige Resolver ist ein spezieller, schleifringloser Drehmelder. Beim Phasen- 
ansteuerverfahren werden in die zwei geometrisch um 90° versetzt angeordneten Stator¬ 
wicklungen zwei harmonische, elektrisch um 90° phasenverschobene Ströme gleicher 
Amplitude eingespeist (Bild 3.34): 

ii(t) = Iq sin oit, i’iCO = Jq cos cot. (3.54) 

In der Rotorwicklung wird eine Spannung % induziert, die sich aus der Überlagerung der 
zwei induzierten Teilspannungen ergibt: 

Mr(0 = ^0 sin {oit + oc). (3.55) 



Stator -L Rotor Drehtrans- | 

I_ format or _| 

Resolver 


Bild 3.34 

Digitale Meßwertbildung aus der Resolverspannung 
a) Blockschaltbild; b) Übertragungsverhalten 

Das ist eine Spannung der gleichen Winkelfrequenz to. Die Amplitude Uq ist bei ge¬ 
eigneter Polgestaltung konstant; der Phasenwinkel oc ist abhängig vom Drehwinkel des 
Rotors relativ zum Stator. Er ändert sich bei einer vollen Rotorumdrehung zwischen 0° 
und 360° und stellt ein analoges Abbildsignal der Meßgröße dar. Die Umsetzung in einen 
digitalen kodierten Meßwert kann ebenso erfolgen, wie es im Bild 3.28 für ein Frequenz¬ 
signal skizziert wurde. Praktisch wird eine Auflösung der vollen Periode in 2000 Teil¬ 
schritte realisiert. Beträgt die Frequenz der Resolverspannung 1 kHz, so muß die Takt¬ 
impulsfolgefrequenz fo dann 2 MHz betragen. 

Der Meßwertaufnehmer arbeitet für eine Rotorumdrehung absolut, die Zahl der Um¬ 
drehungen einschließlich Vorwärts-Rückwärts-Entscheid wird inkremental erfaßt. 

Die dynamischen Eigenschaften ergeben sich aus den Darlegungen im Abschnitt 3.4.2. 
(s. auch Bild 3.34b). 

Zur Anpassung an die jeweiligen mechanischen Baugruppen des Roboters werden 
Resolver z.T. mit Meßgetrieben verwendet. Getriebe bewirken aber stets zusätzliche 
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Meßfehler. Der Einsatz mehrpoliger Resolver (bis lOpolig) wird deshalb vorgezogen. Der 
Bereich, in dem die Meßgröße absolut auf den Signalparameter abgebildet wird, erstreckt 
sich beim lOpoligen Resolver nur über ein Fünftel einer Umdrehung. Die Auflösung ist 
um einen Faktor 5 höher als beim zweipoligen Resolver. 

Die Verfahrgeschwindigkeit ist begrenzt, da nur endlich viele Meßwerte je Zeiteinheit 
am Ausgang der Meßkette bereitgestellt werden. Diese müssen eine eindeutige Erfassung 
der inkremental zu zählenden Grobintervalle durch die Steuerung einschließlich Rich¬ 
tungsentscheid ermöglichen. 

Inductosyn 

Meßprinzip und Auswerteverfahren sind prinzipiell die gleichen wie beim Resolver. Beim 
Rundinductosyn sind Stator- und Rotorwicklungen jeweils in einer Ebene auf Kreis¬ 
scheiben angeordnet, die sich im Abstand von wenigen Zehntelmillimetern gegenüber 
stehen (Bild 3.35). Der Grundkörper besteht aus nichtmagnetischem Material; die Fre¬ 
quenz der eingespeisten Ströme liegt im Bereich 2,5 bis 100 kHz. 180-, 360- und 720- 
polige Rotorwicklungen sind üblich. Bei einem 360poligen Rotor sind 180 Leiterzeug¬ 
perioden symmetrisch auf dem Vollkreis angeordnet; eine Leiterzugperiode entspricht 
einer vollen Umdrehung beim zweipoligen Resolver. Eine Auflösung von 1 Winkel¬ 
sekunde ist realisierbar. 



Bild 3.35. Rundinductosyn - Prinzipskizze der Stator- und Rotorwicklung 


Bei Transformation der Leiterzüge des Rundinductosyns von Zylinderkoordinaten in 
kartesische Koordinaten erhält man aus der Wicklung des Stators die des Gleiters und 
aus der Wicklung des Rotors die des Lineals für das Linearinductosyn (Bild 3.36). Für 
Positionieraufgaben an Robotern ist wegen der geringen Masse das Bandinductosyn 
interessant, bei dem die mäanderförmigen Leiterzüge des Lineals auf einem etwa 0,2 mm 
dicken, nichtmagnetischen Stahlband aufgebracht sind, das sich in einer Führung des 
Gleiters bewegt. Die Leiterzugperiode beträgt im allgemeinen 2 mm, die Auflösung beim 
Bandinductosyn 10 [xm. Induktive phasenzyklische Meßsysteme werden aufgrund ihrer 
Robustheit, ihrer Störsicherheit auch bei Verschmutzung sowie der hohen Auflösung und 
der einfachen Anpassung an die Steuerung häufig eingesetzt. 

Auf weitere phasenzyklische Meßsysteme mit magnetischem, optoelektronischem und 
kapazitivem Wandler soll an dieser Stelle hingewiesen werden [3.13] [3.14]. 

Das Übertragungsverhalten der phasenzyklischen Verfahren kann durch ein Laufzeit¬ 
glied beschrieben werden. Die Laufzeit ist beim Resolver und beim Inductosyn reziprok 
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proportional der Frequenz der eingespeisten Ströme. Eine zusätzliche Verzögerung resul¬ 
tiert aus der geschwindigkeitsabhängigen Frequenzänderung der induzierten Spannung 
während der Bewegung des Meßwertaufnehmers. 


3.4.4. Messung von Geschwindigkeit und Beschleunigung 

Für die Realisierung zeitoptimaler Bewegungsabläufe eines Roboters sind von der 
Steuerung auch Informationen über die aktuelle Bewegungsgeschwindigkeit der einzelnen 
Achsen zu verarbeiten. Durch Differentiation des analogen Abbildsignals des Weges steht 
ein solches für die Geschwindigkeit zur Verfügung. Allerdings erhält man die Geschwin¬ 
digkeitsinformation zeitlich erheblich verzögert, wenn das Wegsignal selbst - abhängig 
von der Signalverarbeitung in der Meßkette - bereits zeitlich verzögert abgebildet wird. 
Vor allem wirken sich bei der Differentiation des analogen Wegsignals die diesem stets 
überlagerten höherfrequenten Rauschspannungskomponenten äußerst störend auf das 
Geschwindigkeitsabbildsignal aus. Der Meßwert kann von der Störung völlig überdeckt 
werden. Durch die notwendige Filterung wird das Geschwindigkeitssignal am Filter¬ 
ausgang zusätzlich verzögert. Eine zeitoptimale Steuerung ist dann nicht möglich. Bei 
der Ermittlung der Geschwindigkeit aus der Beobachtung des digitalen Wegsignals in 
konstanten Zeitabständen treten ähnliche Probleme auf. 

Aus den genannten Gründen kann für die Steuerung schneller Bewegungsabläufe eine 
unabhängige Geschwindigkeitsmessung erforderlich werden. Für rotatorische Bewegung 
werden Tachogeneratoren angeboten, die eine der Drehzahl proportionale Gleichspan¬ 
nung liefern. Die Welligkeit dieser Ausgangsspannung ist die das dynamische Über¬ 
tragungsverhalten des Tachogenerators bestimmende Größe. 

Eine direkte Messung der Beschleunigung der einzelnen Achsen ist bei den gegebenen 
Bewegungsmöglichkeiten eines Robotergreifers problematisch. Bei Verwendung mehr- 
komponentiger, piezoelektrischer Beschleunigungsaufnehmer können die in den einzelnen 
Achsen auftretenden Beschleunigungen nicht ohne weiteres getrennt voneinander erfaßt 
werden. Jedoch kann die Beschleunigung jeder Achse indirekt über die Ermittlung des 
zeitlichen Stromverlaufs in den jeweiligen Achsantrieben ermittelt werden. 



4. Bewegungssteuerung 


4.1. Grundprobleme 

Die Bewegungssteuerung dient dem Ziel, die Bewegungsbefehle des Roboterprogramms 
auszuführen. Dabei sind drei unterschiedliche Aufgabentypen zu unterscheiden (Bild 4.1); 

- Bewegung des Roboters von einer Ausgangsposition in eine Zielposition (Positionier¬ 
aufgabe, Bild 4.1a). Der Bewegungsverlauf zwischen den beiden Positionen ist meist 
ohne technologischen Belang, wodurch sich Freiheiten für eine Optimierung der Bewe¬ 
gung beispielsweise nach minimalem Zeit- oder Energieaufwand ergeben. Diese Art der 
Bewegung ist typisch für Handhabungsgeräte zum Beschicken von Be- und Verarbei¬ 
tungsmaschinen, aber auch für Industrieroboter zum Punktschweißen. 




Bild 4.1 

Grundprobleme der Bewegungssteuerung 

a) Positionieraufgabe 

b) Bahnsteueraufgabe 

c) Bahnsteuerung mit Zusatzbedingung 


- Bewegung des Handpunktes auf einer vorgeschriebenen Bahn mit vorgeschriebener 
Geschwindigkeit, wobei meistens auch die Handachsen zur Orientierung des Werk¬ 
zeugs bzw. Greifers eine kontinuierliche Bewegung ausführen (Bahnsteueraufgabe, 
Bild 4.1b). Hier ist der Bewegungsverlauf in allen Achsen genau vorgeschrieben. 
Freiheiten für eine Optimierung ergeben sich höchstens bei Beschleunigungs- und 
Bremsvorgängen längs der abzufahrenden Bahnkurve. Diese Bewegungsart ist typisch 
für Industrieroboter der ersten Generation zum Lichtbogenschweißen und Farb¬ 
spritzen. 

- Orientierung an einer vorgeschriebenen Bahn unter Einhaltung zusätzlicher Bedingun¬ 
gen. Diese Bedingungen werden durch von den Raumkoordinaten abhängige Größen 
formuliert, deren Wert während der Bewegung konstant gehalten oder einen Extremwert 
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annehmen soll. Erfaßt werden sie durch geeignete Sensoren (Bahnsteuerung mit Sensor¬ 
führung, Bild 4.1 c). Solche Bewegungsaufgaben sind in der Regel überbestimmt, und es 
ist durch das Steuerungssystem ständig ein Kompromiß zwischen Bahntreue und Ein¬ 
haltung der Zusatzbedingungen zu schließen. Typisch ist diese Art der Bewegung für 
Industrieroboter mit Sensorführung zur Oberflächenbearbeitung, zum Lichtbogen¬ 
schweißen und für gewisse Fügevorgänge bei der Montage. 

u(t] g(t) 

—► gilt) 

Bild 4.2 

• 

» , gjf'j Blockschema der Bewegungssteuerung 


Die Bewegungssteuerung wird durch eine Funktionsgruppe gleichen Namens realisiert, 
die den Antrieben Steuergrößen u{t) = «2(0» • • •. Wn(0) so zuführt, daß die roboter¬ 
spezifischen Achskoordinaten ^(0 = (^i(^), ■■•» ^«(0) die geforderte Bewegung 

ausführen (Bild 4.2). Diese erfolgt gemäß der Bewegungsgleichung des kinematischen 
Systems, die in allgemeiner Form 

M{q) q + N {q, q) = P (4.1) 

lautet [4.3]. Hier sind bei n Freiheitsgraden der kinematischen Kette 

M{q) eine /i*«-Matrix aus von q abhängigen Trägheits- und Massekoeffizienten, 

N (q, q) eine «*1-Matrix (Spaltenvektor) der Wechselwirkungskräfte und -momente 
(Zentrifugal- und Corioliseflfekte) zwischen den Koordinatenbewegungen 
P eine «*1-Matrix (Spaltenvektor) der die Bewegung verursachenden Kräfte und 

Drehmomente. 

Die Kräfte und Momente P werden durch die Antriebe aufgebracht, die ihrerseits 
durch die Steuergrößen « angesteuert werden. Dabei treten in der Regel geschwindigkeits-' 
abhängige Rückwirkungen auf, wie im Abschnitt 4.2. und im Abschnitt 3. genauer ge¬ 
zeigt wird. Die Modellgleichungen für die Antriebe sind daher in der Form 

Pi = a(qi,Ui); i=l,2,...,n (4.2) 

oder vektoriell 

P = A(q, u) 
anzusetzen. 

Nimmt man eine additive Überlagerung der Steuerwirkungen u und der Rückwirkun¬ 
gen durch q an, so entsteht aus (4.2) 

Pi = a^qi) + i = 1,2,...,« (4.3) 

bzw. 

P = A(q) + B(u) 

und mit (4.1) für das Gesamtsystem 

M(q) q + N (q, q) = A(q) + B{u). (4.4) 

Hier können die n*l-Matrizen N {q, q) auf der linken und A(q) auf der rechten Seite zu 
einer Matrix iV* (q, q) = N(q, q) — /1(4) zusammengefaßt werden, und für das Gesamt¬ 
system kinematische Kette mit Antrieben ergibt sich schließlich 

M{q) q + N* {q, q) = B{u). 


Bmegungs- 

befehl 


Bmegungs- 

steuerung 


Ujiri 


u^d) 


Und) 



kinematisches 

System 


X 



(4.5) 
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Das den Gin. (4.1) und (4.3) zugeordnete Signalflußbild ist im Bild 4.3 angegeben. Der 
rechte Teil entsteht dadurch, daß man zunächst Gl. (4.1) nach q auf löst: 

q = M-^(P - N(q,q)). (4.6) 

Eine Kette von zwei (vektoriellen) Integratoren erzeugt aus q die Werte von q und q, die 
in ihrer Gesamtheit die Zustände des kinematischen Systems darstellen. Zwei statische 
Blöcke realisieren die Verknüpfungen gemäß und N {q, q) und sind entsprechend 
Gl. (4.6) zusammenzuschalten. Die Blockstruktur des linken Teiles von Bild 4.3 ergibt 
sich in offensichtlicher Weise aus Gl. (4.3). 



Bild 4.3. Signal flußbild des kinematischen Systems und der Antriebe 


Die Aufstellung der Gl. (4.1) für konkrete Roboterkonfigurationen wird im Ab¬ 
schnitt 4.2. gezeigt, Modelle für die Antriebe werden im Abschnitt 3. besprochen. 

Eine Grundaufgabe bei der Untersuchung kinematischer Ketten ist die Bestimmung 
der Bewegung der Kette bei vorgegebenem Zeitverlauf der treibenden Kräfte und Mo¬ 
mente P, also die Lösung der Bewegungsgleichung (4.1). Für die Zwecke der Bewegungs¬ 
steuerung ist die Lösung der Umkehraufgabe von besonderem Interesse. 



Bild 4.4 

Kombinierte Steuerung und Regelung mit 
einem inversen Modell 


Vorgegeben sind die Bewegungsverläufe, gesucht sind die Kräfte und Drehmomente, 
die zu ihrer Ausführung notwendig sind. Die exakte Lösung dieses Problems würde bei 
Einbeziehung der Modelle für die Antriebe gleichzeitig den Algorithmus für die Bewe¬ 
gungssteuerung im Bild 4.2 liefern. Praktisch stößt ein solches Vorgehen vorwiegend aus 
zwei Gründen auf Schwierigkeiten: Zum einen sind die nach Gl. (4.5) erforderlichen Be¬ 
rechnungen von u aus q, q und q sehr rechenintensiv und mit derzeit für Robotersteuerun¬ 
gen einsetzbaren Rechnern in Echtheit nicht realisierbar; zum anderen ist eine so präzise 
Modellierung des Systems kinematische Kette-Antriebe aufgrund nichterfaßbarer Stör¬ 
einflüsse praktisch unmöglich. Ein Ausweg ist eine Berechnung der erforderlichen Stell¬ 
größe u über ein angenähertes inverses Modell und eine Feinkorrektur dieser Stellgröße 
durch ein unterlagertes Regelungssystem. Das führt auf eine Struktur nach Bild 4.4. 
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Da das Problem der Bewegungssteuerung als Ganzes schwierig zu lösen und die ent¬ 
sprechenden Algorithmen noch schwieriger zu implementieren sind, teilt man es in der 
Regel in zwei Teilprobleme mit klar definierter Schnittstelle: in die Bahnkurvenberech¬ 
nung („Interpolation“) und in die Servoregelung. Das führt auf eine Verarbeitungsstruk¬ 
tur nach Bild 4.5a. Ein Bahnkurvenrechner berechnet aufgrund des vorgegebenen Be¬ 
wegungsbefehls die aufeinanderfolgenden Werte der zu verfahrenden Bahnkurve und gibt 
sie als Sollwerte auf das Servoregelungssystem, das in der Regel als Folgeregler ausge¬ 
bildet ist. 



Bild 4.5 

Bahnkurvenberechnung und 
Servoregelung 

a) allgemeine Funktionsaurteilung 
der Bewegungssteueraufgabe 

b) Ansteuerung entkoppelter 
Achsen 


Probleme der Bahnkurvenberechnung werden im Abschnitt 4.6. behandelt. 

Die Servoregelung hat die Aufgabe, die Roboterachsen entsprechend den vorgegebe¬ 
nen Bewegungskoordinaten zu verfahren. Entwurfs- und Bemessungskriterien für dieses 
funktionelle Teilsystem sind 

- das Störverhalten, d.h. das weitgehende Ausregeln von a priori nicht bekannten oder 
erfaßten Störgrößen und Parameterveränderungen im kinematischen System und in 
den Antrieben, wie Reibungen, Lastvariationen und Kraftrückwirkungen durch den 
Bearbeitungsvorgang (beispielsweise beim Schleifen und Fügen); 

- das Positionierverhalten, d.h. das zeitgünstige und Überschwingfreie Erreichen von 
Sollpositionen vor allem bei Beschickungs-, Punktschweiß- und Montageaufgaben; 

- das Folgeverhalten, d.h. das exakte Einhalten der vorgegebenen Trajektorie und der 
programmierten Geschwindigkeitswerte, etwa beim Lichtbogenschweißen, Farbsprit¬ 
zen und bei der Oberflächenbearbeitung. 

Da sich diese Forderungen nicht alle gleichzeitig optimal erfüllen lassen, ergeben sich 
das konkrete Bemessungskriterium und die zusätzlichen Nebenbedingungen jeweils aus 
den Anforderungen der Klasse technologischer Aufgaben, die mit einem bestimmten 
Industrieroboter gelöst werden sollen. 

Prinzipiell ist aufgrund der mechanischen Konstruktion von Industrierobotern die 
Servoregelung ein Problem der vermaschten Regelung, wobei zunächst die Werte von 
q{t) vorgegeben sind (Bild 4.5a). Eine Verbesserung des Verhaltens der Servoregelung ist 
durch Einbeziehung der Ableitungen q{t) in Form einer unterlagerten Geschwindigkeits¬ 
regelung oder direkt als Sollwertvorgabe möglich. Die Lösung der Aufgabe der Servorege¬ 
lung wird durch das Vorhandensein von nichtlinearen Verkopplungen zwischen den 
Achsen erschwert. Hier schaffen Verfahren der kombinierten Entkoppelung und Rege¬ 
lung Abhilfe, von denen eines im Abschnitt 4.3. behandelt wird. Bei einfachen Einsatz¬ 
fällen, bei denen an die Bewegungsdynamik des Roboters keine allzu hohen Ansprüche 
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gestellt werden, können auch die Verkopplungen zwischen den Achsen bei der Modell¬ 
bildung vernachlässigt werden. Sie gehen dann als Störgrößen in die achsspezifischen 
Servoregelungssysteme ein. Beide Vorgehensweisen führen zu einer Struktur nach 
Bild 4.5b. Die einzelnen Achsen werden dabei jede für sich nach den Sollwertvorgaben 
des Bahnkurvenrechners servogeregelt. Das ist bei vielen derzeit industriell ausgeführten 
Industrierobotern der Fall. Eine Behandlung der Einzelachsregelung findet sich im 
Abschnitt 4.4. 

Betrachtet man die Servoregelung einer einzelnen Achse, so zeigt sich der Einfluß der 
Bewegungen der anderen Achsen durch additive Störkräfte [A(^, q) im Bild 4.3] und 
durch eine Beeinflussung der Parameter der Regelstrecke [M~^(q) im Bild 4.3]. So ist 
z. B. die Stellung des Roboterarms von wesentlichem Einfluß auf das effektive Trägheits¬ 
moment der Grunddrehachse. Dieser Art Einflüsse kann durch die Verwendung von 
adaptiven Reglern Rechnung getragen werden, die sich einer Veränderung des Verhaltens 
der Regelstrecke anzupassen vermögen. Aspekte der adaptiven Regelung sind im Ab¬ 
schnitt 4.5. dargestellt. 

Mit den vorstehenden Grundlagen werden im Prinzip die Lösungen der ersten beiden 
eingangs genannten Bahnsteueraufgaben erfaßt. Bei der dritten Aufgabe ist die Steuerung 
der Antriebe nicht nur von der gewünschten Bahnkurve und dem aktuellen Bewegungs¬ 
zustand des Roboters, sondern zusätzlich noch von weiteren Sensorsignalen abhängig 
zu machen. Solche Sensoren, die Informationen über äußere Bedingungen der Roboter¬ 
bewegung, wie Nähe zu einem Hindernis, Andruckkraft während einer Bewegung, Masse 
des zu handhabenden Werkstücks liefern, nennt man äußere Sensoren, im Unterschied 
zu den inneren Sensoren, die über den Zustand des kinematischen Systems, damit auch 
über den aktuellen Bewegungszustand, informieren. Bei der Einbeziehung äußerer Sen¬ 
soren in die Bewegungssteuerung entsteht eine weitere Rückführung (Bild 4.6). Die 



Bild 4.6 

Bewegungssteuerung mit 
Sensorsignalverarbeitung 


Sensorsignale werden dem Bahnkurvenrechner zugeleitet und bewirken hier eine Ände¬ 
rung der zu verfahrenden Bahnkurve so, daß die durch die Sensoren erfaßten Zusatz¬ 
bedingungen eingehalten werden. Im einfachsten Fall ist dies durch eine zusätzliche Auf¬ 
schaltung der Sensorsignale auf die Servoreglermischstelle im Bild 4.6 möglich; i. allg. 
wird die Sensorsteuerung der Servoregelung im Sinne einer Kaskadierung von Regel¬ 
kreisen übergeordnet. 


4.2. Modelle für das Gnindgerät und die Antriebe 

4.2.1. Allgemeine Ansätze 

Ziel der Modellierung des Grundgeräts und der Antriebe ist es, eine geeignete Beschrei¬ 
bung der Regelstrecke zur optimalen Auslegung der Servoregler zu finden. Im Prinzip 
ist dabei die der vorliegenden mechanischen und Antriebskonfiguration entsprechende 
konkrete Form der Matrizen M{q), N (q, q) in Gl. (4.1) und A (q, u) in Gl. (4.2) zu be¬ 
stimmen. Die Kinematik und die dynamischen Parameter der Hauptachsen haben bei 
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den am häufigsten angewendeten Konstruktionen den größten Einfluß auf das dynami¬ 
sche Verhalten des Grundgeräts. 

Die am weitesten verbreiteten Strukturen der Hauptachsen sind die DDD- und die 
DDL-Strukturen (s. auch Bild 3.2). Im Bild 4.7 sind einige dieser Strukturen detaillierter 
dargestellt. Es ist zu erkennen, daß sich die Antriebe für Achse 1 am Grundgestell ab¬ 
stützen, die Antriebe für Achse 2 an Achse 1. Unterschiedliche Lösungen existieren für 
den Antrieb der Achse 3; er stützt sich entweder an Achse 1 (Bild 4.7 b und c) oder an 
Achse 2 (Bild 4.7 a und d) ab. 

Im zweiten Fall ist die Relativlage jedes Kinematikglieds zu dem in der Kette davor¬ 
liegenden eindeutig von einem Antrieb bestimmt. Im ersten Fall wird die Relativlage des 
letzten Gliedes zum vorletzten durch zwei Antriebe festgelegt. 

Eine immer vorhandene Verkopplung besteht über das kinematische System sowie 
zwischen Antrieben und Kinematik, da die Antriebskraft nicht nur von der Eingangs¬ 
spannung, sondern auch von der Geschwindigkeit des mit dem kinematischen System 
verbundenen Antriebs abhängt. Ein Antriebsgrobmodell, gültig für elektrischen und 
elektrohydraulischen Antrieb, ist aus den Bildern 3.12 und 3.18 erkennbar. Eingangs¬ 
größen eines Antriebs i sind die dem Steller bzw. dem Servoventil zugeführte Spannung Ui 
und die auf die Antriebsachse bezogenen Geschwindigkeiten des kinematischen Systems 
ij bzw. (pi, allgemein qf, Ausgangsgrößen sind die vom Antrieb erzeugten, auf das kine¬ 
matische System wirkenden Kräfte oder Momente allgemein P, (Bild 4.7 e). 

In einer ersten Modellierungsstufe (Schwerpunkt: Modelle des kinematischen Systems; 
s. Abschnitte 4.2.2. und 4.2.3.) wird nur dieses Grobmodell des Antriebs angewendet; 
im Abschnitt 4.2.4. wird das Antriebsmodell detaillierter betrachtet. 

Die analytischen Methoden zur Modellierung des mechanischen Grundgeräts können 
in zwei Hauptgruppen unterteilt werden [4.3] [4.10]: 

- Methoden auf der Grundlage der Newtonschen Axiome, der Euler-Zerlegungen und 

des d’Alembertschen Prinzips, 

- Methoden auf der Grundlage der Lagrangeschen Bewegungsgleichungen 2. Art. 

Im ersten Fall werden für die einzelnen Glieder die Schwerpunkt- und Drehimpulssätze 
angesetzt [4.10]: 

mss — F = 0 (d’Alembertsches Prinzip) (4.7) 

df df i i ( 

m Gesamtmasse des Gliedes 
F Kraftvektor 

Lagevektor des Schwerpunktes 
N Drehimpulsvektor. 

Ausgehend von den kartesischen Koordinaten ergeben sich für ein Kinematikglied sechs 
Bewegungsgleichungen und für ein kinematisches System aus n Gliedern 6« skalare Be¬ 
wegungsgleichungen [s. auch Gl. (3.1)]. Besitzt das System /Freiheitsgrade, dann sind 
6n — f zusätzliche Gleichungen, die die Bindungen untereinander beschreiben, zu formu¬ 
lieren, was oft sehr schwierig ist. Die Aufstellung der Bindungsbedingungen wird durch 
die Annahme federnder Verbindung der kinematischen Glieder untereinander verein¬ 
facht ; die Zahl der Bewegungsgleichungen ist dadurch jedoch groß. 

Die Anwendung von Methoden, die die Lagrangeschen Bewegungsgleichungen 2. Art 
nutzen, haben sich für mehrgliedrige kinematische Systeme als sehr leistungsfähig er- 
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wiesen [4.8] [4.9]. Nur müssen die dem Freiheitsgrad entsprechende Anzahl Zustands¬ 
größen ins Modell aufgenommen werden und damit für ebenso viele Koordinaten q^ die 
Lagrangeschen Bewegungsgleichungen 2. Art aufgestellt werden. Sehr günstig lassen sich 
die eingeprägten Kräfte berücksichtigen (Antriebskräfte und -momente). 



Bild 4. 7. Typische Strukturen der Hauptachsen 1, 2 und 3 von Ihdustrierobotergrundgeräten 

a), b) mit hydraulischen Antrieben; c), d) mit elektrischen Antrieben; e) Grobmodell eines beliebigen Antriebs 


Aus der Lagrangeschen Funktion L 

^ ~ ^kin ~ ^pot 

ergibt sich für jede Koordinate 

„ „ d dL dL 

Z - ~77 ^ ’ 

j Qt ctji oqi 

kinetische Energie des Systems 
^pot potentielle Energie des Systems 

Pij eingeprägte Kräfte und Momente, in der Koordinate wirkend. 


(4.9) . 

(4.10) 


In den folgenden Abschnitten werden beide Wege der Modellierung anhand von Bei¬ 
spielen demonstriert. 

Die z.B. in [4.3] ausführlich beschriebenen rechnergestützten Modellierungsverfahren 
nutzen im wesentlichen dieselben Grundlagen wie die analytischen Methoden (erweitert 
um die Appelschen Gleichungen und das Gaußsche Prinzip) und erleichtern die konkreten 
Berechnungen bei komplizierten Strukturen des kinematischen Systems erheblich. 


4.2.2. Modellierung mit Hilfe der Lagrangeschen Bewegungsgleichungen 2. Art 

Am Beispiel von zwei Strukturen soll die Vorgehensweise deutlich werden. 

Die Struktur des ersten Beispiels ist [4.9] entnommen (s. auch Bild 4.7 d). Für diese 
DDL-Struktur werden die Bewegungsgleichungen für den Fall 

- Drehantrieb 1 bewegt, 

- Schwenkantrieb 2 in Ruhe (Lage waagerecht), 

- Linearantrieb 3 waagerecht bewegt 

aufgestellt. Im Bild 4.8a ist das Bewegungsschema mit den interessierenden Kräften, 
Koordinaten und Abmessungen dargestellt: 

- Erster Schritt ist die Ermittlung der potentiellen und kinematischen Energie — Fpot=0. 
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- Die kinetische Energie der Masse aml setzt sich aus den Teilen rotatorische Kom¬ 
ponente (mJ2) (SitpiY und translatorische Komponente (mJ2) sl zusammen. 

- Die kinetische Energie der Masse die über die Länge / gleichmäßig verteilt ist und 
den Schwerpunkt S „3 hat, wird ebenfalls von S 3 und (pi bestimmt. Der translatorische 
Anteil beträgt (ma/l) 53 , der rotatorische (J 3 I 2 ) <pl. Dabei ist 


J3 = J(Sm3) + W3AJ3 = -I- m 3 ^^3 - 0 

Es ergibt sich die Lagrangesche Funktion L zu 

T r ^ 2 ^3 / . 2 / 2 j \ 

L = Fkin ^ ^-j 

Mit Hilfe von Gl. (4.10) ergeben sich über 



, ;2 , / 2 . 2 
+ ^3 -I- Y i^ 3 fl 



(4.11) 


ÖL 

d<pi 


JiVi + m3(pi 



+ Wl«5PiJ3 


dL 

dtpi 


= 0 


^ = {m 3 -f mj S 3 
dS3 


SL .2 .2 I 

= /«l9iJ 3 + ^39^1 Ua - - 
CS3 \ 2 


die Bewegungsgleichungen 


Fz = {m3 + Wl) S3 - (^3 + S3(p\ + m 



= (Wa + mj S3 + Fp {S3, (pi) 


(4.12) 


/2 

Ml = ^1 (Ji + (^3 + Wl) J3 -I- AWa-AAia/ja) 

3 


+ 2S3(pi 


^AAAlJ 3 + AA 73 



= J'is 3 ) (pi 4- Mc (J 3 , S3, (pi). (4.13) 

Die jeweils zweiten Summanden der rechten Seite der beiden Bewegungsgleichungen sind 
die Fliehkraft Ff und das Coriolis-Moment Mq. Es ist zu erkennen, daß über sie eine 
Kopplung zwischen beiden Achsen besteht, die bei langsamen Bewegungen vernach¬ 
lässigbar klein wird. 

Die Struktur des Systems einschließlich der Abtriebe (Grobmodell) ist im Bild 4.8b 
dargestellt. 



84 


4. Bewegungssteuerung 


Die Rückwirkung von (p ^, 53 auf den jeweiligen Antrieb ist zu erkennen [s. zum Ver¬ 
gleich Gl. (4.3)]; sie beeinflußt sowohl in elektrischen als auch in hydraulischen Antrieben 
die auf das kinematische System wirkenden Kräfte. 



al 


1 1 



Bild 4.8. Verkopplungen der Achsen 1 und 3 in einer DDL-Struktur (ermittelt mit Hilfe des Lagrange- 
schen Formalismus) 

a) Schema; b) Signalflußbild 


Als zweites Beispiel werden die Achsen 2 und 3 eines Industrieroboters in Gelenkarm¬ 
bauweise gewählt (Bild 4.7 a oder b). 

Für die Energiebilanz, die nach Bild 4.9a aufgestellt wird, ergeben sich unabhängig 
von der Antriebsgestaltung (Bild 4.9 b, c und d) folgende Beziehungen (die Massen und 
Massenträgheitsmomente der Antriebe selbst werden dabei voraussetzungsgemäß dem 
kinematischen System zugeschlagen): 


^■poti = /2i(sin <p2) ntjg 

Epoti = (I22 sin (p2 + I32 sin 993) Wjg 
/^s2 W 2 

^kinl — ( ^ 


(4.14) 


^kin: 


Js 


3 . 2 . ^3 

— T'a + — 
2 2 


2 

3 • 


Die Geschwindigkeit V 3 der Masse wird wie folgt ermittelt: Aus 

V 3 =^sl^ + sly ( 4 . 15 ) 

und 

^ 3 ^ = I22 COS (P 2 + I32 cos 993 
J3y = I22 sin 992 + I32 sin 993 
hx = -I 22 sin (p 2 q >2 - I 32 sin 993993 
■^3, = I22 cos 992992 + I32 cos 993993 
ergibt sich 

vl = iL + sly = l],2(p2 + Il 2 <p 3 + 2/22/32 COS (992 - 993)992993. ( 4 . 16 ) 
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Die Lagrangesche Funktion ist damit 


T * ^ 

L = (p2 




I ■ 2 

+ <?3 



+ ^3/22/32COS( 9?2 - (P 3 )<p 2 (p 3 - gsin(p 2 im 2 l 2 i + ^1^22) - 3(^12132) 


= <^2 +f 3 -^ + j* cos («^2 - <^ 3 ) f2(p3 - Ms 2 sin (P 2 - Ms3 sin (p 3 . 


(4.17) 


Stimmen die Antriebsbewegungen mit den beschreibenden Koordinaten überein, hier 
(p 2 , fp 3 (s. Bild 4.9b: Antrieb 3 stützt sich entsprechend der Festlegung für 993 hinsicht¬ 
lich des Drehmoments an Achse 1 ab; das kommt dem Fall nach Bild 4.9d nahe), so sind 
die weiteren Schritte relativ einfach, da Gl. (4.17) vor der Berechnung der entsprechenden 
Ableitungen nicht umgeformt werden muß. 




Bild 4.9 

Gestaltungsvarianten der Achsen 2 und 3 einer 
DDD-Struktur 

a) Schema des kinematischen Systems; b), c), d) Antriebs¬ 
varianten 


Über die Ableitungen 
BL 


d(p2 

BL 

B(p2 

BL 

Sf3 

BL 

S<P3 


= (P2J2 + J* cos ((P 2 - 993) <p 3 
= j* (p 2 (p 3 (-sin i(p 2 - <P 3 )) - M '^2 cos (P 2 
= 9Ö3J3 + J* cos ((P 2 - 993) <P 2 
= J*(p2(p3 sin (992 - 9P3) - ^s3 cos 993 
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ergibt sich 

M2 = ^2J2 + cos {(p2 - (pz) + J*(p\ sin (952 - 9^3) + M^2 cos 92 

= ^2*^2 + ^ 3 J*ed + ^F2 + ^S2 ( 4 - 18 ) 

M3 = 93-^3 + ^2J* COS (92 - 93) - J*<P2 sin (92 - 93) + Ms3 cos 93 

= V3J3 + 92 «/rtd - ^F 3 + Ms 3 - ( 4 . 19 ) 

Diese Bewegungsgleichungen sind im Bild 4.10 als Signalflußbild dargestellt, wobei die 
Grobmodelle der Antriebe berücksichtigt wurden. 

Die Kopplungen zwischen den Bewegungen sind wiederum ausgeprägt, wobei zum 
Fliehkrafteinfluß (Mp2, ^¥3) Einflüsse der Schwerkraft {M^2, ^53) und der Kopplungen 
der Trägheitsmomente hinzukommen 

Coriolis-Momente treten bei diesem ebenen Problem nicht auf. Das wird schon dann 
nicht mehr gegeben sein, wenn sich der Antrieb 3 , wie üblich bei einem Drehantrieb, an 
der Achse 2 vollständig abstützt (s. Bild 4 . 9 c), da dann die entsprechende Koordinate 
nicht als Winkel 93 zwischen fester x-Achse und Unterarm, sondern als Winkel 93 
zwischen beweglichem Ober- und beweglichem Unterarm beschrieben werden muß. 

Das führt auf die Beziehung 

93 = 7 C - 92 -f 93. ( 4 . 20 ) 

In die Lagrangesche Funktion L nach Gl. ( 4 . 17 ) muß dann 

für 93; 93 -1- 92 — Tc 

für 93: 93 + 92 

für cos (92 — 93): —cos 93 

für sin 93: —sin (92 + 93) 

eingeführt werden. 

Das ergibt 

L = 92 — + (92 + 93) — - J* (cos 93) 92 (92 + 93) 

2 2 

- Afs2 sin 92 + Ms3 sin (92 + 93) ( 4 . 21 ) 

und führt unter Anwendung von ( 4 . 10 ) zu den folgenden Beziehungen: 

^2 = 92 {J2 + J3 - 27 * cos 93) + 93 (J3 - J* cos 93) -f 27 * (sin 93) 9293 
+ 7 * sin 9393^ -I- M^2 cos 92 — Ms3 cos (92 + 93) ( 4 . 22 a) 

M'3 = 9373 + 92 (73 - 7 * cos 93) - 7 * (sin 93) (pl - Ms3 cos (92 + 93). 

( 4.22 b) 

Das zugehörige Blockschaltbild ist im Bild 4.10 angegeben. Die Beziehungen ( 4 . 22 a) und 
( 4.22 b) lassen sich auf die Form 

M2 = (fzJz + 9373 + A{(P2, 93 , 92 ,93) 

M 3 = 9273 + 9373 + B ( 92 ,93, 92 ) 


(4.23 a) 
(4.23 b) 
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bringen, wobei (p 2 und cp'^ in beiden Gleichungen auftreten. Das führt bei der Nachbildung 
auf einem Rechner auf eine algebraische Schleife, die im Bild 4.10 markiert ist und die zu 
numerischen Schwierigkeiten führt. Um sie zu beseitigen, werden die Gin. (4.23 a) und 
(4.23 b) als lineares Gleichungssystem geschrieben 

= ^ 2 g = ^2 - Ai(p 2 ,(p 3 ,(P 2 , (pi) (4.24a) 

+ fiJs = ^3e = ^3 - B((p2,(p'3, (p2) (4.24b) 

und nach (p 2 und ^3 aufgelöst: 


M2^J3 - M2,J3 

J2J3 - J3 


¥3 = 


M 3 J 2 - M2,J3 

J2J3 - J3 


(4.25 a) 


(4.25 b) 



Bild 4.10 

Signalflußbild der Verkopplungen 
der Achsen 2 und 3 einer DDD- 
Struktur nach Bild 4.9 a und b 
(ermittelt mit Hilfe des Lagran- 
gesehen Formalismus) 

-.-algebraische Schleife 


Hier kommen auf den rechten Seiten keine Beschleunigungen mehr vor, und die alge¬ 
braische Schleife ist beseitigt. Dieses Verfahren entspricht einer Diagonalisierung der 
Matrix M{q) und ist damit auch im Fall von mehr als zwei Dimensionen durch mathe¬ 
matische Standardverfahren ausführbar. Ist die Antriebsgestaltung wie im Bild 4.9d, 
muß die Lagrangesche Funktion L weiter umgeformt werden, damit die Koordinaten 
S\ 2 , Sx 3 anstelle von cp 2 und cp^ (bzw. 9 J 3 ) enthalten sind. 

Es ist leicht zu erkennen, daß 

9^2 = > 

9^3 = f(ßA2 ■> ^A3) 

ist, wobei in typischen Arbeitsbereichen der Einfluß von Ja 2 auf cp^, vernachlässigt wer¬ 
den kann, so daß das Modell nach Bild 4.10 einfach an das für das System nach Bild 4.9d 
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angepaßt werden kann. Wesentlicher Vorteil der Ermittlung der Bewegungsgleichungen 
mit Hilfe des Lagrangeschen Formalismus ist auch hier, daß ein Starrkörpermodell der 
niedrigstmöglichen Ordnung und damit nur mit den wesentlichen Zustandsgrößen er¬ 
arbeitet wird. 


4.2.3. Modellierung über die allgemeine Bewegung starrer Glieder 


Im Abschnitt 3.2.2. sind die Bewegungsgleichungen des massebehafteten, rotationsträgen, 
starren Kinematikglieds hergeleitet worden. Diese Beschreibung kann verwendet werden 
für kinematische Systeme aus mehreren derartigen Gliedern. Der Beschreibungsaufwand 
wächst mit zunehmender Zahl der Glieder schnell an, da diese Glieder in festzulegender 
Weise nachgiebig miteinander verbunden werden müssen. Allerdings ist die Modellie¬ 
rung der Federwirkungen in den Gelenken zwangsläufig gegeben, während sie bei Ver¬ 
wendung des Lagrangeschen Formalismus mit zusätzlichem Aufwand verbunden ist. 
Für eine ebene DD-Struktur nach Bild 4.7b (Achsen 2 und 3) ist das Gleichungssystem 
noch überschaubar. Das Antrieb-Kinematik-Schema ist im Bild 4.11a dargestellt. Der 
Oberarm besitzt einen, der Unterarm drei Freiheitsgrade (bedingt durch die Feder im 
Gelenk B, deren Verformung die Koppelkraft erzeugt). 

Für den Unterarm sind die folgenden skalaren Bewegungsgleichungen abzuleiten (die 
im Bild 4.11a fehlenden Angaben sind aus Bild 4.9a zu entnehmen): 

^3x^3 ~ f^3x + ^Bx 

53j,W3 = F 3 y - Fßy - Fs3 (4.26) 

*^3‘^S3 = ~ hlx^3y + hlx^By + hly^3x + Uzy^Bx' 


Die Lage der interessierenden Punkte des Unterarms B, C, D sind 


^S3Qx 

= 


+ 

hly 

A99; 

^•S'3By 

= 

Aj3y 

- 

hlx 


^S3Cx 

= 

AJ3.t 

+ 

hly 

A<p- 

^S3Cy 

= 

Aj3y 

- 

hlx 

A(p: 

^•^3Djc 

= 

AJ3x 

- 

^33y 

A(p 

^‘S'3D}> 

= 

A53y 

+ 

^33x 

A(p 


(4.27) 


Die Geschwindigkeit des Punktes C, an dem der Antrieb angelenkt ist, ist für die Rück¬ 
wirkung auf den Antrieb von Interesse. Sie ergibt sich analog 


‘^ 3 Cjc — •^ 3 :*: + l 3 ly ^3 

(4.28) 

^3Cy — ^3y ~ ^31x^3- 

Einfacher ist der Antrieb für den Oberarm. Für ihn kann die Beschreibung des Schwenk¬ 
glieds im Abschnitt 3.2.4. verwendet werden. (Anstelle von Fl tritt die Koppelkraft Fß.) 
Es ist 

4>2 {Js2 + "^2^21) = -^2^A - ^S2^S + ^b/'l ( 4 . 29 ) 


[^A, s. Gl. (3.3)]. 
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4. Bewegungssteuerung 


Von (p 2 allein abhängig sind 5^2 und ^ 2 b; Fb Itann günstig in die jc- und die ^^-Kom- 
ponente zerlegt werden oder auch auf seine Tangentialkomponente reduziert werden. Die 
Koppelkraft ergibt sich aus der Lagedifferenz zwischen 53 ^ und ^28 sowie der Nach¬ 
giebigkeit im Gelenk 3, beschrieben durch die Federkonstante Cg. 

Aus Gründen der Übersichtlichkeit und der Überprüfung auf Vollständigkeit werden 
die angegebenen Beziehungen wiederum in einem Signalflußbild angegeben (Bild 4.11 b). 

Nicht näher eingegangen werden soll auf die Beziehungen zwischen den einzelnen 
Kräften, Momenten, Wegen, Winkeln und ihren Komponenten. Die Faktoren Kj und 
lijk sind im Arbeitspunkt linearisierte Funktionen, die z. T. komplizierte trigonometrische 
Ausdrücke enthalten; in den Funktionen fi ,/2 werden zwei Komponenten zu einem Ge¬ 
samtweg zusammengefaßt. Aufgrund der zusätzlichen Freiheitsgrade im Gelenk B ist 
dieses System höherer Ordnung als die vergleichbaren Modelle im Abschnitt 4.2.2. 
Vorteile der Modellierung über die allgemeine Bewegung starrer Glieder sind: 

- Tatsächlich vorhandene Nachgiebigkeiten können berücksichtigt und auf relevante 
Stellen (z. B. Gelenke) konzentriert werden. 

- Eine Erweiterung auf zusätzliche Achsen ist unter Beibehaltung des Basismodells 
möglich und damit relativ übersichtlich. 

- Der Zeitverlauf von Gelenk- und Koppelkräften und weiterer Größen läßt sich bei 
Rechnungen mit dem Modell einfach verfolgen. 


4.2.4. Einfache Ersatzmodelle für Kinematik und Antriebe 


Die Modelle in den Bildern 4.8b, 4.10, 4.11b sind durch Verkopplung gekennzeich¬ 
net. Werden zusätzlich die in diesen Bildern verwendeten Grobmodelle der Antriebe 
(Blöcke An i) durch die der Bilder 3.12 (elektrohydraulischer Antrieb) oder 3.18 (elek¬ 
trischer Antrieb) ersetzt, so ist zu erkennen, daß die Modelle bereits für zwei Achsen recht 
kompliziert werden. Dabei ist im Bild 3.12 nicht berücksichtigt, daß der elektrohydrau¬ 
lische Antrieb wesentliche Nichtlinearitäten im Servoventil enthält (s. Bild 3.11). Im 
folgenden soll in mehreren Stufen eine Vereinfachung so vorgenommen werden, daß 
Modelle entstehen, die zumindest eine Vordimensionierung der Regler mit einfachen 
Mitteln erlauben. 

Einen Teil von Vereinfachungsmöglichkeiten bietet das kinematische System. 

In den meisten Fällen ist die Rückwirkung der Lage auf das Kräftegleichgewicht ge¬ 
ring, so daß diese in erster Näherung vernachlässigbar ist. 



Bild 4.12 

Signalfluß bei Vernachlässigung der Ver¬ 
kopplung und der Lageabhängigkeit der 
Belastungskräfte im kinematischen System 


Die in den Abschnitten 4.2.2. und 4.2.3. ermittelten Verkopplungen der Achsen sind um 
so stärker spürbar, je größer Geschwindigkeiten und Beschleunigungen sind, denen das 
kinematische System unterliegt. Auf die dann notwendige Entkopplung wird im Ab¬ 
schnitt 4.3. eingegangen. Bei autonomer Regelung jeder Achse (s. auch Abschn. 4.1.) ist 
die Einwirkung des Bewegungszustands einer Achse auf die andere als Störgröße (Stör¬ 
kraft Fz oder -moment Mz) aufzufassen. 

Diese beiden Vereinfachungen führen auf das Signalflußbild einer translatorischen 
Achse i nach Bild 4.12. 
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Zur Ermittlung weiterer Vereinfachungsmöglichkeiten wird der Antrieb selbst näher 
betrachtet. 

Es werden zwei Richtungen verfolgt: 

- der Bereich kleiner Aussteuerungen, in dem Begrenzungen nicht wirksam sind und 
linearisiert werden kann; 

- der Bereich großer Aussteuerungen, in dem Begrenzungen das Verhalten wesentlich 
beeinflussen. 

Für den elektrohydraulischen Antrieb ergibt sich bei Linearisierung das Verhalten 
nach Bild 3.12, das zu den Übertragungsfunktionen gemäß den Gin. (3.18) und (3.19) 
führt. 






Bild 4.13. Modelle für Einzelachsen mit linearem Verhalten der Antriebe 

a)[elektrohydraulischer Antrieb; b) elektrohydraulischer Antrieb, Kompressibilität der Ölvolumina und Verzögerungen im 
Servoventil vernachlässigt; c) elektrischer Antrieb; d) elektrischer Antrieb, Steller mit Stromausgang 


Das entsprechende komprimiertere Signalflußbild ist im Bild 4.13 a dargestellt, wobei 
für die Vorsteuerstufe PFi-Verhalten mit der Zeitkonstante T angenommen wurde. 

Bei sehr kleinen Kompressionsvolumina , V 2 und zusätzlicher Vernachlässigung der 
Verzögerung der Vorsteuerstufe des Servoventils ergibt sich das einfache Modell nach 
Bild 4.13 b, das für viele prinzipielle Betrachtungen ausreichend genau ist. 

Für den elektrischen Antrieb nach Bild 3.18 ergeben sich bei linearem Verhalten 
(Stellerbegrenzung nicht wirksam, Reibung vernachlässigt) die Übertragungsfunktionen 
nach Gl. (3.49) und (3.50). Das entsprechende Signalflußbild (s. Bild 4.13 c) ist demnach 
Bild 4.13 a für r' -> 0 gleich. 

Für relativ kleine Induktivität L (oder bei sog. Stromausgang des Stellers, mit 
dessen Hilfe die von den Induktivitäten hervorgerufene Verzögerung nahezu Null wird) 
ergibt sich T^-* 0 und ein Modell des Elektroantriebs nach Bild 4.13 d, das dem Modell 
nach Bild 4.13 b entspricht. 

Zu beachten ist, daß in den Parametern 2DT, T (Bild 4.13 a und b) und (Bild 4.13c 
und d) die reduzierte Masse w, ,.ed nach Bild 4.12 enthalten ist. 
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Bei großen Aussteuerungen ist beim elektrischen Antrieb lediglich ein Begrenzerblock 
,(s. Bild 3.18) vorzuschalten. Bei Stromansteuerung des Motors ergibt sich das einfache 
Signalflußbild nach Bild 4.14. 

Im elektrohydraulischen Antrieb liegt eine Begrenzerwirkung innerhalb der Rückführ¬ 
schleife (s. Bild 3.12), da gemäß Bild 3.11 das Servoventil eine Begrenzung der möglichen 


Bild 4.14 

Modell einer Einzelachse mit nicht¬ 
linearem Verhalten des elektrischen 
Antriebs 
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Druckdifferenz auf den Druckquellendruck p^Q enthält. Das ist am besten zu erkennen, 
wenn das Kennlinienfeld im Bild 3.11b auf ^pIpoQ = /(sh/sho) mit dem Parameter 
QvlQo umgestellt wird (s. Bild 4.15). 

In erster Näherung kann dieses Kennlinienfeld auf die Form nach Bild 4.15b zurück¬ 
geführt werden, die wiederum leicht in das Signalflußbild nach Bild 4.15 c umgeformt 
werden kann. Das Signalflußbild nach Bild 3.12 kann unter Nutzung von Bild 4.15 c 
in die Form nach Bild 4.15 d gebracht werden. 

Unter der Voraussetzung, daß die kompressiblen Ölvolumina, der Leckleitwert Gl 
und die Reibungseinflüsse klein sind, ergibt sich ein einfaches, die obengenannte 
Begrenzung aber berücksichtigendes Modell dieses elektrohydraulischen Antriebs 
(Bild 4.15e). 

Es ist von den Einsatzbedingungen der Antriebe und von der Zielstellung der Modell¬ 
betrachtung abhängig, ob derart vereinfachte Modelle, wie in den Bildern 4.12 bis 4.15 
dargestellt, angewendet werden können. Ist dies prinzipiell möglich, muß natürlich ge¬ 
prüft werden, welche Stufe der Vereinfachungen noch zulässig ist. 


4.3. Entkopplung der Achsen 

Wie im Abschnitt 4.1. dargestellt, ist das kinematische System mit den Antrieben für die 
Servoregelung eine mehrdimensionale nichtlineare Regelstrecke mit nichtlinearen in¬ 
neren Verkopplungen. Der Entwurf von Reglern für solche Strecken ist ein kompliziertes 
Problem, dessen Lösung durch Teilung in die beiden Arbeitsschritte 

- Entkoppelung der Regelstrecke und 

- Entwurf von Servoreglern für die entkoppelten Teilsysteme 

vereinfacht und damit übersichtlicher gestaltet werden kann. Die Grundgedanken eines 
solchen Verfahrens, das in [4.9] ausführlich beschrieben wird, sollen nachfolgend dar¬ 
gelegt werden. 

Ausgangspunkt ist ein vereinfachtes Modell nach Gl. (4.5): 

M{q) q + N* (q, q) = U. (4.30) 

Dieses Modell kann aus Gl. (4.5) dadurch gewonnen werden, daß entsprechend Gl. (4.3) 
Ui = bi(Ui) bzw. Ui = (Ui) gesetzt und U = (Ui, U 2 , ..., U„) als neuer Steuervektor 
eingeführt wird. Im Signalflußbild (Bild 4.3) bedeutet das, daß dem mit B(u) gekenn¬ 
zeichneten Block links ein Block mit inverser Wirkung vorgeschaltet und somit eine 
Linearisierung des Eingangssignalwegs bis zur ersten Mischstelle links erreicht wird. 
Das zu Gl. (4.30) gehörende Signalflußbild der Regelstrecke ist im umrandeten Feld von 
Bild 4.16a dargestellt. Die Entkopplung verfolgt das Ziel, daß für i = 1, 2 , ...,« das 
i-te Steuersignal ausschließlich auf die Bewegung der i-ten Achse qi wirkt. Da im Bild 4.3 
die Integratoren entkoppelt sind (vgl. die Bemerkungen zur Aufstellung des Signalfluß¬ 
bilds im Abschnitt 4.1.), müssen die durch die Matrizen M~^(q) und N* (q, q) beschrie¬ 
benen verkoppelnden Wirkungen kompensiert werden. Dazu bedarf es des Einsatzes im 
Prinzip gleichgearteter Kompensationselemente. Dies leistet der Ansatz 

U=Ky + yv, (4.31) 

wobei K eine noch zu bestimmende «-Matrix, w ein «-dimensionaler Spaltenvektor 
und y der neue, ebenfalls «-dimensionale Steuervektor sind. 
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K und w sind nun so zu bestimmen, daß das Verhalten des Gesamtsystems Strecke-Ent¬ 
kopplung durch die entkoppelten Gleichungen 

(ii=hyi\ /=1,2, « (4.32) 

oder in Matrixschreibweise 

q = Ay 

mit der Diagonalmatrix A beschrieben wird. Die 2, ; / = 1, 2,..., « sind dabei zunächst 
wählbare Parameter, die eigentlich nur aus Dimensionsgründen vorzusehen sind. 

Durch Einsetzen von (4.31) in (4.30) entsteht zunächst 



nicht lineare verkoppelte Regelstrecke 



Bild 4.16 

Entkopplung der Bewegungsachsen 

a) Signalflußbild von verkoppelter Regelstrecke und Entkopplungs¬ 
gliedern; b) Ergebnis der Entkopplung 


M{q) q -f- N* (q, q) = Ky + w. (4.33) 

Wird hier 

w = N* (q, q) (4-34) 

gewählt, so bleibt von (4.33) die Beziehung 

M(q) q = Ky (4.35) 

übrig, die, nach q aufgelöst, 

q = M~ ^(q) Ky (4.36) 


ergibt. Soll diese Beziehung die in (4.32) geforderte Form haben, so muß 
M-\q)K = A 


(4.37) 
















sein. Daraus bestimmt sich K zu 
K = M{q) A. 
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(4.38) 

Die Beziehungen (4.34) und (4.38) stellen die Bestimmungsgleichungen für w und K aus 
dem Ansatz (4.31) dar, der mit ihnen in die Entkoppelungsbeziehungen 

U = M{q)Ay + N {q, q) (4.39) 

übergeht. Das Signalflußbild (Bild 4.16a) zeigt sehr anschaulich die Wirkung des Ent¬ 
kopplungsverfahrens. Man erkennt, daß das Signal w gerade die Wirkung der Matrix 
N* {q, q) im Rückwärtszweig und die vorgeschaltete Matrix M{q) gerade die Wirkung 
von M~^{q) innerhalb der Strecke auf hebt. Das Gesamtsystem Regelstrecke-Entkopp¬ 
lung verhält sich entsprechend Gl. (4.32) wie ein System von n unverkoppelten Regel¬ 
strecken mit P-Verhalten (Bild 4.16 b). 

Das zweite Teilproblem der Servoregelung besteht darin, für jede dieser Strecken einen 
separaten Regler anzubringen. Eine solche Einzelachsregelung ist viel einfacher zu reali¬ 
sieren als die Regelung eines verkoppelten Systems. Sie wird ausführlich im Abschnitt4.4. 
behandelt. Hier soll als Beispiel angenommen werden, daß proportional wirkende Lage¬ 
regler mit unterlagertem Geschwindigkeitsregelkreis zur Anwendung kommen. Bild 4.17 
zeigt das Signalflußbild eines solchen Reglers für die i-te Achse. Man liest daraus die 
Beziehung 

yi = -Ctqi + di(g,i - q^) (4.40) 

mit 

Ci = kyi und di = kyiki^i 
ab, die für alle n Systeme in vektorieller Form 

y = -Cq+ D(q, - q) (4.41) 

mit den l*rt-Koeffizientenmatrizen C und D notiert werden kann. 

Bild 4.17 

Beispiel eines Servoreglers 
für eine entkoppelte Achse 

Das Gesamtverhalten des geschlossenen Regelungssystems der i-ten Achse ergibt sich 
aus (4.40) mit (4.32) zu 

di + ^Cidi + Xidiqi = Xidiq.i. (4.42) 

Hier sind die Koeffizienten c,, di und A,- so einzustellen, daß sich ein günstiges dynami¬ 
sches Verhalten ergibt. Dafür sind zahlreiche Verfahren und Untersuchungen bekannt 
[4.8]. Das für die Entkoppelung und Servoregelung einzusetzende Regelungssystem wird 
durch die Gin. (4.39) und (4.41) beschrieben. Sie lassen sich zu 

U = M(g) A(-Cq + D(q^ - q)) + N* (q, q) (4.43) 

zusammenfassen. Die Beziehung (4.43) ist durch einen Algorithmus zu realisieren, der U 
aus q^, q und q in Echtzeit bestimmt und den Antrieben als Stellgröße zuführt. Nach¬ 
folgend soll die konkrete Form von Gl. (4.43) für eines der im Abschnitt 4.2. behandelten 
kinematischen Systeme angegeben werden. 
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Als Beispiel wurde das System nach Bild 4.8 gewählt. Für die Durchführung der kon¬ 
kreten Entkopplungsschritte sind die im Bild 4.8b enthaltenen Antriebsgrobmodelle 
detaillierter zu beschreiben. Um überschaubare Zusammenhänge zu sichern, wird ein 
sehr einfaches Antriebsmodell nach Bild 3.12 mit + V 2 -* 0 oder nach Bild 3.18 
mit L + Le 0 und Mr 0 gewählt. In beiden Fällen ergibt sich die allgemeine 
Gleichung 


Pi = Kil (Ui - K^qd. 

(4.44) 

Das ergibt für das System nach Bild 4.8 


Fs — F .31 («3 — K 32 S 3 ) 

(4.45) 

Ml = Kii {ui — Ki2(pi)‘ 



Damit ergibt sich aus Bild 4.8 das zu behandelnde verkoppelte Ausgangssystem nach 
Bild 4.18. 

Mit (4.45) ergibt sich aus (4.12) und (4.13), aufgelöst nach den Beschleunigungen, 


^3 = 


^31 

W 3 + Wl 


«3 


^31^32 
W 3 + /«L 


S3 + S3(pi = 


^ 3 / 

2 (ma -I- Wl) 


• • 2 


(4.46) 


9^1 = 


^11 

J'(S3) 


u, - 


J'(S 3 ) 


<Pt - 2S3(pi 


+ m 3 (s 3 - 1 / 2 ) 

J'M 


(4.47) 


mit /'(Sa) nach (4.13). 

Für die Eingangsspannungen Ui wird im folgenden der Ansatz gemäß (4.31) 

Ui = Ui I + KiUi 2 (4.48) 

gemacht. 

In einer ersten Stufe, der Entkopplungsstufe, gilt es, den Summanden u^ so zu wählen, 
daß das eine Teilsystem das andere nicht beeinflußt. Am einfachsten ist das realisierbar, 
wenn u^ und «31 so gewählt werden, daß gemäß (4.34) , 53 Null werden (s. Bild 4.18). 

Aus Gl. (4.46) ergibt sich als Bedingung für S 3 =0: 


W 31 — K 32 S 3 + 


.2 

- <Pi - 

2 K 3 , 


W3 + Wl .2 

•^3^1 


^31 


— W31 (J3 , S3, <pi) 


(4.49) 


und aus Gl. (4.47) als Bedingung für = 0: 


«11 = + 253«^! 

= «11 (>53,^3, 9^l)- 


mi^S3 -I- W3 (53 - 1/2) 
/^ii 


(4.50) 


Werden die Beziehungen (4.49), (4.50) eingesetzt in (4.46), (4.47), so ergibt sich [vgl. 
mit (4.36)]: 

"" ■ (4.51) 


■53 = 


und 


ma + Wl 

K,, 


^3«3; 


L'(^3) 


K 1 U 12 • 


<Pi = 


(4.52) 
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Das ist im Bild 4.19 a dargestellt. Dieses einfache Verhalten ist dem des Teiles Ausgangs¬ 
system -I- Entkopplung im Bild 4.18 gleich. Die Realisierung der Entkopplung [Be¬ 
ziehungen (4.49), (4.50) für «n, M 31 ] in einem realen System erfordert die Messung 
von zahlreichen Zustandsgrößen und aufwendige Berechnungen der Steuergrößen «n 
und « 31 . 

In der zweiten Stufe gilt es, den Vorwärtszweig zu vereinfachen [s. Gl. (4.38)]. Er ist 
in vielen Fällen [s. J'(s 3 )] nichtlinear; dies erschwert die Reglerauslegung. Die Lineari- 



Bild 4.18. Behandlung des verkoppelten Systems nach Bild 4.8 in drei Stufen 



a) nach der Entkopplung; b) nach Entkopplung und Behandlung des Vorwärtszweigs; c) nach Entkopplung, Vorwärtszweig 
und Regelung 


7 Industrierobotersteuerung 
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sierung, in jedem Fall aber eine Vereinfachung, wird erreicht, wenn gemäß (4.51), (4.52) 
und (4.37) 




■^ 31^3 
^3 + Wl 


Ax = 


J\s,) 


gesetzt wird. 

Das ergibt als Korrekturgrößen für den Vorwärtszweig: 




ns,) 

n, ’ 


K, = A 3 


m, + mL 

^31 


(4.53) 


Damit bleiben zwei nur mit dem Faktor A,. bewertete Integratorketten nach Bild 4.19b 
übrig, deren Verhalten dem des Teiles Ausgangssystem + Entkopplung + Behandlung 
des Vorwärtszweiges im System nach Bild 4.18 identisch sind. 

Nunmehr können in der dritten Stufe die Regler für beide Untersysteme getrennt ent¬ 
worfen werden. Unter den geschaffenen Voraussetzungen können die bekannten Ver¬ 
fahren zur Synthese linearer Folgeregelungen ohne Einschränkungen angewendet werden. 
Die Vervollständigung zur Regelung [es wurde eine einfache Form wie in (4.40) bis 
(4.42) gewählt] ist in den Bildern 4.18 und 4.19 c dargestellt (w^ Führungsgröße der Ften 
Achse). In diesem Fall gilt 

Ui2 = w.^io - qiaii - qiüa- (4.54) 

Die Übertragungsfaktoren üiq, können den Anforderungen an das statische und 

dynamische Verhalten entsprechend für jede Achse getrennt frei gewählt werden, ohne 
daß ein Einfluß auf die andere Achse entsteht, vorausgesetzt, die Beziehungen zur Ent¬ 
kopplung und zur Behandlung des Vorwärtszweigs werden ausreichend genau und zu den 
richtigen Zeitpunkten ermittelt. Gleiches gilt natürlich auch für die innerhalb der Rege¬ 
lung zu berechnenden Größen für die Spannungen Ui, und « 33 . 

Die Kompliziertheit des Systems vergrößert sich mit wachsender Zahl der verkoppel¬ 
ten Achsen beträchtlich (s. auch [4.9]), was zu erhöhtem Rechenaufwand für Entkopp¬ 
lung und Regelung führt. Eine weitere Erhöhung der Kompliziertheit des Gesamtproblems 
entsteht auch, wenn die Verzögerungen in den Antrieben selbst nicht mehr vernachlässig¬ 
bar sind. Dann wirken die Eingangsspannungen auf höhere als die zweiten Ableitungen 
der Positionen nach der Zeit direkt (d.h. unverzögert) ein. Die angestrebte Integratorkette 
besteht dann aus mehr als zwei Integratoren. Der aufgezeigte Weg ist hier ebenfalls 
prinzipiell begehbar; er ist aber mit weiterer Zunahme des Aufwands für die Entkopp- 
lungs-, die Vorwärtszweig- und die Regelungsberechnungen im realen System verbunden. 

Ausgehend von diesen Problemen wird in [4.11] ein Zweiebenenkonzept (eine hier¬ 
archische Regelungsstruktur) vorgeschlagen, das von einem Mehrprozessorsystem zu 
realisieren ist. In der unteren Ebene erfolgt bei kleiner Abtastzeit die autonome Regelung 
der Teilsysteme und in einer oberen, in der Koordinationsebene, bei größerer Abtastzeit 
die aufwendige Berechnung der Entkopplung und die Behandlung des Vorwärtszweigs. 
Dieser Weg erscheint in der Zukunft erfolgversprechend. 


4.4. Einzelachsregelung 

4.4.1. Optimales Positionieren 

Das Überführen eines Industrieroboters von einer Stellung in eine andere in möglichst 
kurzer Zeit ist eine häufig wiederkehrende Steuerungsaufgabe. Dieses Positionierproblem 
soll für eine Bewegungsachse anhand des vereinfachten Modells im Bild 4.20 betrachtet 
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werden. Man gewinnt dieses Modell entweder nach dem im Abschnitt 4.3. behandelten 
Entkopplungsverfahren oder aus den im Abschnitt 4.2.4. behandelten einfachen Ersatz¬ 
modellen unter Vernachlässigung der Geschwindigkeitsrückwirkungen (vgl. die Bil¬ 
der 4.14 und 4.15). Obwohl es eine sehr starke Idealisierung des dynamischen Verhaltens 
einer Bewegungsachse darstellt, lassen sich wesentliche Grundprobleme der Positionie¬ 
rung an diesem Modell studieren. 


d^x _ ^ 
dt^ ” dt 




Bild 4.20 

Idealisiertes Modell einer Bewegungsachse 


Bild 4.21 

Zeitverläufe der Position x, der Geschwindigkeit v und der 
Steuergröße u bei einem zeitoptimalen Positioniervorgang 



Die zu Bild 4.20 gehörende Bewegungsgleichung lautet 


dV 


u. 


(4.55) 


Der Einfachheit halber wird dabei angenommen, daß die Beschleunigung direkt die Stell¬ 
größe der Strecke ist. Führt man die Geschwindigkeit v = dx/dt ein, so entsteht aus 
(4.55) das Gleichungssystem 


dv , , 

— = uiO-. 

dt 


dx . . 
— = v(t). 
dt 


(4.56) 


Diese Gleichungen, die das dynamische Bewegungsverhalten der idealisierten Achse be¬ 
schreiben, werden als Zustandsgleichungen für dieses System, der Vektor v(t), x(t)y als 
Zustandsvektor oder kurz als Zustand bezeichnet. 

Die Positionieraufgabe läßt sich damit so formulieren: 

Gesucht ist ein Stellgrößenverlauf u(t) so, daß das durch die Gin. (4.56) beschriebene 
System von einem Anfangszustand (0, Xq)^ in einen Endzustand (0,0) in kürzestmöglicher 
Zeit 


T = \ dt = 
0 


dx 

vix) 


übergeführt wird. Die Stellgröße (Beschleunigung) soll dabei gemäß 
|w(01 ^ b 


(4.57) 


beschränkt sein. 




100 


4. Bewegungssteuerung 


Dieses Optimierungsproblem hat eine sog. „bang-bang“-Regelung zur Lösung [4.12] 
[4.13]. Sie besteht darin, daß bis zur Hälfte des zurückzulegenden Weges jcq mit höchst¬ 
möglicher Beschleunigung, anschließend mit höchstmöglicher Verzögerung verfahren und 
abschließend die Steuergröße auf Null geschaltet wird. Bild 4.21 zeigt die zugehörigen 
Zeitverläufe für die Stellgröße u (Beschleunigung), die Geschwindigkeit v und den Ver¬ 
fahrweg X. Daß u{t) in der Beschleunigungsphase und v(t) im gesamten Zeitintervall ne¬ 
gativ sind, liegt daran, daß die Bewegung von einem Ausgangswert jcq in negativer jc-Rich- 
tung zum Punkt jc = 0 erfolgt. In den beiden Bewegungsphasen Anfahren und Brem¬ 
sen gelten die folgenden Beziehungen: 



t 


u{t) 

y(0 x(t) 

Anfahrphase 

0 ^ t 

T 

< — 

2 

-b 

— bt Xo- 

2 

Bremsphase 

L< 

2 

t < T 

+b 

-2ii„ + bi - (r - T)^ 

2 


(4.58) 


Dabei errechnet sich die maximale Geschwindigkeit zu 
= \/ bxo 


(4.59) 


und die Positionierdauer zu 


T = 2 



(4.60) 



Bild 4.22 

Trajektorien von zeitoptimalen Positioniervorgängen in 
der Zustandsebene 


Trägt man die Geschwindigkeit v über dem Weg x auf, so erhält man die Zustands- oder 
Phasenebene des Systems. Da sich beide Größen mit der Zeit ändern, beschreibt der End¬ 
punkt des Vektors {v{t), x(0)^ eine Trajektorie in der Zustandsebene. Man kann sie aus 
den Zeitverläufen von v{t) und x{t) im Bild 4.21 konstruieren oder allgemeiner die Schar 
aller möglichen Trajektorien aus den Zustandsgleichungen (4.56) durch Elimination der 
Zeit gewinnen. Dividiert man formal (4.56a) durch (4.56b), so entsteht die Differential¬ 
gleichung 

^ (4.61) 

ax V 

deren Lösung für konstantes u 

y(x) = \J vl + 2u{x — ATo) (4.62) 

die Trajektorie beschreibt, die durch den Punkt (vq, Xq)^ verläuft. Damit sind die Tra¬ 
jektorien in der ^r-y-Ebene liegende Parabeln, die für m > 0 nach rechts, für « < 0 nach 
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links geöffnet sind. Bild 4.22 zeigt einige Trajektorien für Positionierbewegungen. Von 
besonderer Bedeutung ist dabei die sog. Schaltkurve, die durch die aus (4.62) zu gewin¬ 
nende Beziehung 


V 


' —yjlbx für jc > 0 
0 für jc: = 0 
,V2 ^>|a:| für < 0 


— sgn(A:)-s/2^7|A:| 


(4.63) 


beschrieben wird. Sie trennt in der Zustandsebene zwei Gebiete voneinander, wo im 
Sinne der oben dargestellten optimalen Steuerstrategie die Stellgröße ihren positiven 
Maximalwert (unterhalb und auf der Schaltkurve) bzw. ihren negativen Maximalwert 
(oberhalb der Schaltkurve) annehmen muß. Für die „bang-bang“-Regelung ergibt sich 
damit die Funktionsgleichung 


b für V > — sgn(x) \/2Z> Ix:] 

— b für v< — sgn(x) V 2Z) |jcl, 


(4.64) 




Bild 4.23. „bang-bang“-Regelung mit Strukturumschaltung 

a) Steueralgorithmus; b) Signalflußbild 


auf deren Basis das optimale Regelungssystem entworfen werden kann. Es wird aller¬ 
dings nur dann zufriedenstellend arbeiten, wenn das dynamische Verhalten der Bewe¬ 
gungsachse exakt durch die Gin. (4.56) beschrieben wird und die Umschaltpunkte nach 
Gl. (4.64) auf das genaueste eingehalten werden. Da dies in der Praxis nicht gegeben ist, 
wird das Steuerungssystem nur unvollkommen funktionieren. Meist kommt es in der 
Umgebung des Zielpunktes zu unerwünschten Schwingungen. Um dies zu vermeiden, 
kann man in einer Umgebung |x:| ^ um den Zielpunkt den „bang-bang“-Regler nach 
(4.64) durch einen linearen Regler ersetzen [4.14] [4.8]. Der entsprechende Steuer¬ 
algorithmus ist im Bild 4.23 a dargestellt. Bild 4.23 b zeigt dazu die Strukturumschaltung 
des Reglers im Signalflußbild. Darin ist als Beispiel das erste I-Glied des Ausgangs¬ 
modells von Bild 4.20 durch ein P7"i-Glied ersetzt worden. Das entspricht bei geeigneter 
Bemessung der Zeitkonstanten der Einbeziehung einer streckeninternen Geschwindigkeits¬ 
rückführung (vgl. Abschn. 4.2.4.), und das Verhalten der Regelstrecke wird nur noch in 
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grober Näherung durch die Gin. (4.56) beschrieben. Dennoch ist der Algorithmus nach 
Bild 4.23 a für ein angenähert zeitoptimales Positionieren verwendbar [4.8]. 

Bei großen Positionierwegen ergeben sich nach Gl. (4.59) hohe Maximalgeschwindig¬ 
keiten v^, die häufig durch die Antriebe nicht erreicht werden. In solchen Fällen ist mit 
Geschwindigkeitsbegrenzungen zu rechnen, und zu Gl. (4.57) kommt noch die Bedingung 

|y(0l = «^max (4.65) 

mit einer festen Maximalgeschwindigkeit hinzu. In diesem Fall vollzieht sich der Posi¬ 
tioniervorgang in der Regel in drei Phasen: 

t u(t) v(t) x{t) 


Anfahrphase 0 ^ 


-b -bt 


Xn - t‘ 


tx = 


Bewegung mit t < t-, 

V = ümax 


0 Tn 


Bremsphase t 2 ^ t < T 


Xo + 

2b 


bXn , b , 

-t’max- + bt -(t- Tf 


rj< _ ■^0 ^max 


Xo 


(4.66) 


Bild 4.24 zeigt die dazugehörigen Zeitverläufe. Für die Positionierdauer T ergibt sich 


T = 



für 

für 


l^max > V bXo 


^max bXQ , 


und mit den Normierungsgrößen 


(4.67) 


To 



und = V bxo 


entsteht daraus 



für 


für ^^max ■ 


(4.68) 


Dabei wird jeweils im ersten Fall Vmax nicht erreicht, und die Positionierung vollzieht sich 
ohne Geschwindigkeitsbegrenzung (jeweils erste vier Trajektorien rechts und links vom 
Ursprung im Bild 4.25). Im zweiten Fall bewirkt die Geschwindigkeitsbegrenzung ein 
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Auftreten einer Bewegungsphase mit konstanter Geschwindigkeit (?) und damit eine 
Vergrößerung der Positionierdauer. Die Zustandsbewegung vollzieht sich nur in einem 
durch V ^ fmax definierten Streifen in der Zustandsebene (Bild 4.25). 



b 

1_ 








ti t2 

t 

-b 





Bild 4.24 

Zeitverläufe bei zeitoptimalem Positionieren 
mit Begrenzung der Geschwindigkeit 


4.4.2. Lineare Servoregler 


Die lineare Regelungstechnik ist theoretisch wie praktisch sehr weit ausgebaut. Deshalb 
werden lineare Regler auch für die Servoregelung von Roboterachsen bevorzugt ein¬ 
gesetzt, obwohl sie infolge der vorhandenen Nichtlinearitäten und der sich bei der Be¬ 
wegung verändernden Parameter der Regelstrecke nicht im gesamten Verfahr bereich 
des Roboters optimal eingestellt werden können. Nachfolgend soll das Führungsverhal- 
ten linearer Lageregler bei Positioniervorgängen für das einfache Modell nach Bild 4.26a 
untersucht werden. Die Regelstrecke entspricht im Prinzip den Modellen von Bild 4.14 
und Bild 4.15. Geregelt wird sie durch einen proportional wirkenden Lageregler A?, dem 
ein proportionaler Geschwindigkeitsregler unterlagert ist. Aus Bild 4.26 liest man 
direkt die Zustandsgleichungen 


— = -KjiV Ko {-V + - x)) 

dt 

dx _ 

dt 


(4.69) 


ab, von denen die erste mit den Abkürzungen A? + Ag = und in 

^ = -KAv + (^w - ^)) (4.70) 

dt 


übergeht. Das entspricht der Struktur nach Bild 4.26 b. Zur Untersuchung des Positionier¬ 
verhaltens wird angenommen, daß sich bei = Xq = konst. der Regelkreis im ein¬ 
geschwungenen Zustand {dvjdt = 0, y = 0, x = x,,, = Xq) befindet und zum Zeitpunkt 
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r = 0 die Führungsgröße auf Null geschaltet wird. Dann ist zur Ermittlung der Zeit¬ 
verläufe A:(t) und v{t) das homogene Gleichungssystem 

dy 

-K^v- K^K^x 

dt 


dx _ 
dt 


(4.71) 


Regler Regelstrecke 



Kx Kv 



Bild 4.26 

Lineare Lageregelung 

a) Signalflußbild von Regler und 
Strecke ;'b) vereinfachtes Signal¬ 
flußbild; c) normiertes Verhaltens¬ 
modell 


oder die dazu äquivalente Differentialgleichung 2. Ordnung 


d^jc djc 

dt^ dt 


(4.72) 


mit den Anfangsbedingungen 


40) = ;ro, 

dt 


= y(0) = 0 


zu lösen. Mit der Normierung r = Kj, | = x/K^ und K = KJK„ entsteht daraus 
dy 

- = -V - 

dr 


dr 


(4.73) 


= y 


und 


dr^ dr 


(4.74) 
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Die zugehörige Blockstruktur ist im Bild 4.26c dargestellt. Der Lösungstyp der Differen¬ 
tialgleichung (4.74) ist von den Wurzeln ihres charakteristischen Polynoms + p + K 
= 0 , _ 

Pi,2 = -i + Vi - Ji: (4.75) 

abhängig. Für Positionieraufgaben ist dabei der aperiodische Grenzfall K = \ (Doppel¬ 
wurzel pii 2 = —i), bei dem der Positioniervorgang gerade ohne Überschwingen erfolgt, 
von Bedeutung. Hier lautet die Lösung von (4.73) 


S(t) = «0) fl + e-"^ 

v(r) = . 


(4.76) 


Ist ein gewisses Überschwingen unkritisch, so kann K > ^ gewählt werden. Dann lautet 
die Lösung von (4.73) 


u. . ^ sinßrX 

^(t) = 1(0) / cos ür + j 

vir) = — — 1^(0) sin üx 
ü 

mit Q = K — 


.-t/2 


(4.77) 


Bild 4.27 zeigt dazu die Zeitverläufe von Position, Geschwindigkeit und Beschleuni¬ 
gung, Bild 4.28 die entsprechenden Trajektorien in der Zustandsebene. In der letzteren 
kann auch das Verhalten der Beschleunigung studiert werden. Man erhält dazu aus der 
Gleichung von (4.73) mit b = dy/dr = konst. die Gleichung 


v= -b - (4.78) 

für die Linien konstanter Beschleunigung. Es sind parallele Geraden, deren Steigung 
durch — Ä'und deren Abschnitt auf der y-Achse durch —b gegeben sind. Mit b = ü sind 
sie für K = 0,25 (unterbrochene Linie) und für K — 0,5 (strichpunktierte Linie) im 
Bild 4.28 eingetragen. 

Ein Vergleich der Zeitverläufe und Trajektorien mit denen im Bild 4.21 bzw. im 
Bild 4.22 zeigt, daß das Verhalten der linearen Lageregelung in der gewählten Form be¬ 
trächtlich vom optimalen Verhalten abweicht. 

Für eine günstige Bemessung von k kann Bild 4.27 als Anhaltspunkt dienen. Da die 
Lösung der Gl. (4.74) erst für t ^ oo abgeklungen ist, verwendet man als Maß für die 
Positionierdauer diejenige Zeit, ab der ||(t)| ständig unter einer vorgegebenen Schranke, 
beispielsweise 1 % vom Anfangswert |(0), bleibt. Sie soll mit Tj bezeichnet werden. Es 
zeigt sich, daß man diese Zeitdauer gegenüber der beim aperiodischen Grenzfall noch 
deutlich senken kann, wenn ein geringes Überschwingen zugelassen ist. Man vergleiche 
dazu die Verläufe von x{t) im Bild 4.27. Die Überschwingweite s ist durch das Minimum 
von iixm) aus Gl. (4.77) an der Stelle Tn, = tz/Q gegeben. Es berechnet sich folglich zu 

5 = (4.79) 

und wird meist in Prozent angegeben (^% = 100 s). Bild 4.29 zeigt die Abhängigkeit der 
1- %-Positionierdauer Tj ^ und der Überschwingweite in Abhängigkeit von K. Man er¬ 
kennt, daß günstige Einstellwerte für K im Bereich 0,25 bis 0,35 liegen. 
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Bei den Betrachtungen zur Modellbildung in den Abschnitten 3. und 4.2. ist mehrfach 
auf immer vorhandene Begrenzungen im Regler und in der Strecke hingewiesen worden. 
Um den Einfluß solcher Begrenzungen zu untersuchen, werden die beiden linearen Regler 



r—► 

Bild 4.28. Zustandstrajektorien beim Positionieren mit 
linearer Regelung 



\ 

m 

-0.5 



Bild 4.27 

Zeitverläufe von Position, Geschwindigkeit und Be¬ 
schleunigung beim Positionieren mit linearer Regelung 



Bild 4.29. Abhängigkeit der 1-%-Po- Bild 4.30. Lineare Lage- und Geschwindigkeitsregler mit 
sitionsdauer und der Überschwingweite Begrenzung 

von k a) Signalflußbild; b) zur Festlegung der Funktionenund/„ 
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im Bild 4.26 a durch solche mit Begrenzungen ersetzt und die Reibung vernachlässigt 
{Kx = 0). Das entstehende Signalflußbild (Bild 4.30a) ist dem von Bild 4.26b struktur¬ 
äquivalent. Damit gelten anstelle von (4.69) die Zustandsgleichungen 


fvi-V + fAx^ - Jf)) 

dr 

dx 


(4.80) 



Bild 4.31 

Gebietsaufteilung der Zustandsebene durch 
die Begrenzungen 


die für einen Positioniervorgang wieder mit = 0 und den Anfangsbedingungen 
x(0) = Xo und y(0) = 0 zu lösen sind. Die beiden Funktionen und sind mit den ent¬ 
sprechenden Bezeichnungen im Bild 4.30b angegeben. Da sie stückweise definiert sind, 
wird die Zustandsebene in verschiedene Gebiete aufgeteilt, in denen die erste der beiden 
Gleichungen (4.80) jeweils spezielle Formen annimmt. Im Bild 4.31 sind diese Gebiete 
mit den entsprechenden Formen der Gleichung für dvjdt = v dargestellt. Außerhalb des 



Bild 4.32 

Zustandstrajektorien für Positio¬ 
niervorgänge bei Begrenzungen 


schraffierten Streifens sind beide Regler übersteuert, innerhalb arbeitet der Geschwindig¬ 
keitsregler (/J in seinem linearen Bereich. Der Lageregler {ff) arbeitet im mittleren Gebiet 
und ist für |x| > Xg übersteuert. Durch abschnittsweises Lösen der Differentialgleichun¬ 
gen (4.80) erhält man die Zeitverläufe bzw. Trajektorien des Positioniervorgangs. Typi¬ 
sche Trajektorien sind im Bild 4.32 dargestellt. Ist jxo| > Xg, so erfolgt der Positionier¬ 
vorgang in drei Phasen: 

Beide Regler sind übersteuert; die Bewegung erfolgt mit maximal möglicher Be¬ 
schleunigung; die Geschwindigkeit nimmtlinear zu, die Position mit ab. Die Tra¬ 
jektorien sind Parabeln (Bild 4.22). 
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Der Geschwindigkeitsregler arbeitet in seinem Proportionalbereich, die Geschwindig¬ 
keit strebt exponentiell dem Endwert — AT^JCg zu; die Abnahme der Position erfolgt 
anfangs exponentiell, später linear. 

Beide Regler arbeiten in ihrem Proportionalbereich. Es gelten dabei die Gin. (4.71), 
deren Lösungen bereits diskutiert wurden. 

Berücksichtigt man, daß der Begrenzung Xg des Lagereglers in der Praxis einige Milli¬ 
meter entsprechen, so ist zu erkennen, daß der Positioniervorgang überwiegend bei über¬ 
steuertem Lageregler, d.h. praktisch bei olfenem Lageregelkreis verläuft. Erst in der 
letzten Phase des Bremsens und Einfahrens in die Position werden beide Regler wirksam. 
Um die nahezu unkontrollierte Bewegung der Achse in den ersten beiden Phasen zu ver¬ 
meiden, empfiehlt es sich, durch eine geeignete Sollwertaufbereitung und -führung Soll¬ 
wertsprünge auszuschließen und so Lage- und Geschwindigkeitsregler während des ge¬ 
samten Positioniervorgangs im Proportionalbereich zu halten. Das wird im nachfolgen¬ 
den Abschnitt besprochen. 


4.4.3. Fühnmgsverhalten des Antriebs 


Um den Antrieb innerhalb der gesamten Bewegungsphase trotz vorhandener Stellgrößen¬ 
beschränkungen im Regelbereich betreiben zu können, ist es erforderlich, eine Führungs¬ 
größe bereitzustellen, der der Antrieb jederzeit zu folgen vermag (Nachlaufregelung). 
Das ist insbesondere dann wichtig, wenn beim Positionieren mehrere Achsen verfahren 
werden und sich der Greiferendpunkt auf einer definierten (wenn auch oft nur grob 
tolerierten) Bahn bewegen soll. Die dabei prinzipiell gültigen Zusammenhänge zwischen 
Kennwerten der Regelstrecke und erforderlicher Führungsgröße sollen am einfachen 
linearisierten Antriebsmodell nach Abschnitt 4.2.4. bzw. Bild 4.13 erläutert werden. Das 
Verhalten des Antriebs ist durch folgende Übertragungsfunktionen zu beschreiben: 


Führung 

GAp) 


Störung 

Gr(p) 


x(p) 

uip) 

xjp) 

F(P) 


K, 1 

1 + TmP P 


Kf ]_ 

1 + TmP P 


(4.81) 

(4.82) 



Bild 4.33 

Vereinfachtes Signalfluß¬ 
bild der Lageregelung 


Die Speziellen Faktoren Kp und sind gemäß Abschnitt 4.2.4. zu bestimmen. (Be¬ 
achte: Die Größen können arbeitspunktabhängig sein.) 

Zur Vermeidung von Übersteuerungen sind anstelle von Eingangssprungfunktionen 
stetige (bzw. stückweise stetige) Führungsfunktionen dem Regelkreis aufzuschalten. Die 
einfachste Form ist eine Rampenfunktion w(t) — VqI. Die Gesamtübertragungsfunktion 
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Gy,{p) = x{p)lw{p) mit einem einfachen P-Regler [Gr(/7) = ^r] berechnet sich nach 
Bild 4.33 zu 


Gy>{p) = 


(«0 Eigenfrequenz 
D Dämpfung. 


x{p) 

w{p) 


1 + 


1 




P + -^p^ 
K„K^ 


, 2D 1 , 

1 + - p + —p^ 

(Oq OJq 


_ 1 

l +T,p + Tlp^ 


(4.83) 


Der Zeitverlauf der Regelgröße x{t) für »v(r) = VqI ergibt sich aus der Lösung der zu¬ 
gehörigen Differentialgleichung 


40 = ^0 


t - 


2D 

COq 


— e 


1 - 2Z)' 


cooVl - 


sm\ 


/l - 


COot 


2D 


-cos V 1 — ojQt 

COo 


(4.84) 



Bild 4.34 

Qualitativer Verlauf x(t) für rampenför¬ 
miges Eingangssignal bei unterschiedlichen 
P- (PD-) Rückführungen 


Mögliche Antwortfunktionen sind im Bild 4.34 dargestellt. Die bleibende stationäre 
Regelabweichung beträgt 

2D Vq 

x^ = X — w = - Vq = -. (4.85) 

tOo 


Sie steigt mit zunehmender Rampensteilheit und sinkt mit wachsender Reglerverstärkung. 
Kt^ kann zur Erzielung kleiner Abweichungen jedoch nicht beliebig vergrößert werden. 
Das zeigt eine Betrachtung der Dämpfung des Einschwingvorgangs nach Gl. (4.83): 


D = 


h. 

2T^ 


1 




(4.86) 


Sie sinkt mit steigendem Ä'r ; der Übergangsvorgang verläuft schwingend; die stationäre 
Phase wird später erreicht. Ein schnelles Einschwingen wird mit D = 0,7 erzielt. Für 
gegebenen Antrieb ^m) ist die dazu erforderliche Reglerverstärkung 


= 




(4.87) 
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womit sich eine bleibende Folgeabweichung 

= X — w = —2TmVq (4.88) 

einstellt. Demgemäß darf für eine vorgegebene zulässige Abweichung a:,vzui der Rampen¬ 
anstieg der Führungsgröße Vq den Wert 


^0 max 


zul 


(4.89) 


nicht überschreiten. Die Zeitkonstante des Antriebs legt so die größtmögliche Änderungs¬ 
geschwindigkeit der Führungsgröße fest. Bei einer Sättigungsgrenze des Reglerausgangs 
von ±Uo ergibt sich jc^^zui = UqIK^^. 

Bei Einführung eines zusätzlichen D-Anteils ergeben sich folgende Veränderungen : 


a) zusätzlicher D-Anteil im Regler (PD-Regler) 


u = (w — :t) + 7V 


d (w — x) 
dt 


X 


W 


Vq 

KuKy, 


1 + KK^Ty 

2 sIk^K^Tu 


(4.90) 


Während sich gegenüber reinem P-Regler die statische Folgeabweichung nicht ver¬ 
ändert, steigt die Dämpfung D, was bei gleichem Gesamtdämpfungsfaktor [s. Gl. (4.86)] 
eine Vergrößerung von Är zuläßt. 

b) Rückführung der Regelgröße x über PD-Glied auf die Summationsstelle 


u — ATr 


(w - a:) + Fv 

dt _ 


x^ 


1 + KuKf^Ty 


1 + 


(4.91) 


Die statische Abweichung vergrößert sich. Gleichzeitig tritt eine Dämpfungserhöhung 
auf. 

c) Führungsgröße wird über PD-Glied auf das Summationsglied geschaltet 
u = |^(w - x) + Fv 





Vq, 


D = 


1 

2Va:„a:rFm ' 


(4.92) 


Durch die Wahl von Fy = I/ATuAr kann der Folgefehler zu Null (für Fy > 1 /A„Ar 
sogar positiv) gemacht werden. Die Dämpfung bleibt gegenüber P-Regler erhalten. 
Es ist zu beachten, daß D-Anteile leicht zur Übersteuerung der Reglerbaugruppe 
führen und zu den berechneten Folgefehlern noch die Abweichungen infolge wirk¬ 
samer Störkräfte zu addieren sind. 


A;c = —^ F, (4.93) 

A„Ar 

die, sofern die Belastung variabel ist, mit D-Anteilen nicht zu kompensieren sind. 
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Eine Verbesserung des Führungsverhaltens besteht in einem dem Regelkreiseingang 
vorgeschalteten Korrekturglied G ^., das als Übertragungsfunktion den Reziprokausdruck 
der Führungsübertragungsfunktion GyXp) besitzt. Die bei theoretischer Betrachtung 
ideale Maßnahme (G'ges = = 1) der vollständigen Kompensation der 

Regelkreisdynamik hat jedoch praktische Grenzen: 

- In der Übertragungsfunktion des Regelkreises 

CM ^ ^ = iW ^ 1 + Ty.p + Ti,p- + ... + 

.</.) N(p) I + r,/» + Tlp^ + ... + r„>" 

ist das Nennerpolynom in der Regel höheren Grades als das Zählerpolynom (m > n). 
Im Korrekturglied muß demzufolge das Zählerpolynom höherer Ordnung als das 
Nennerpolynom sein, was technisch nicht realisierbar ist (maximal Gleichheit). Damit 
beschränkt sich diese Methode auf die Kompensation nur einiger, für den Regelvorgang 
ungünstiger Zeitkonstanten. 

- Bezüglich der zu bildenden Abweichungen (w, w usw.) muß die Führungsfunktion 
stetig (dilferenzierbar) sein. 

- Indem der Reglereingang neben der Regelabweichung zusätzlich mit den zeitlichen 
Ableitungen der Führungsgröße beaufschlagt wird, kann er rasch übersteuert werden, 
so daß praktisch der entsprechende D-Anteil nicht mehr wirksam ist. 

- Die tatsächlichen Antriebsmodelle können komplizierter sein und aussteuerungs¬ 
abhängige Parameter haben. 

Die in Gl. (4.93) berechnete Abweichung Ax infolge äußerer Belastungskräfte F kann 
stationär nur durch I-Anteile im Regler beseitigt werden. (Beachte: Ein reiner I-Regler 
bedeutet strukturinstabilen Regelkreis, deshalb Verwendung von PI- bzw. PID-Varian- 
ten.) In [4.15] wird anschaulich gezeigt, wie viele I-Anteile installiert sein müssen, um 
für spezielle Eingangsfunktionen 0 zu sichern. Für w{t) = bßt^ (parabelförmiger 
Verlauf, vgl. Bild 4.21) sind z. B. drei I-Anteile in der Übertragungsfunktion des offenen 
Regelkreises zur Vermeidung stationärer Nachlauffehler erforderlich. 

I-Komponenten im Regler können mit folgenden Nachteilen verbunden sein: 

- Sie begünstigen die Schwingneigung (deshalb oft relativ große Nachstellzeiten not¬ 
wendig; stationärer Zustand wird entsprechend spät erreicht). 

- Überschwingfreies Einlaufen in die Position wird erschwert (deshalb wird der I-Anteil 
oft begrenzt bzw. in der Verfahrphase sogar vollständig abgeschaltet). 

In den bisherigen Betrachtungen wurde nur die stationäre Abweichung betrachtet, da 
sie mit einfachen Gleichungen beschreibbar ist. Die dynamischen Abweichungen - zu 
ermitteln über die Lösung von (teilweise nichtlinearen) Differentialgleichungen - können 
die hier berechneten Werte oft wesentlich überschreiten. Geht man jedoch davon aus, 
daß beim Positioniervorgang das Verfahren mit konstanter Geschwindigkeit [entspricht 
w(t) = ^ 0 ^] dem größten Teil der Bewegungsphase entspricht (vgl. Bild 4.35) und dort 
der stationäre Zustand erreicht wird, können die angegebenen Gleichungen als grobe 
Näherung bei Festlegung maximaler Änderungsgeschwindigkeiten der Führungsgröße 
zur Vermeidung des Arbeitens im Sättigungsbereich angesehen werden. 

Für praktische Anwendungen werden für Positionieraufgaben aus den abgespeicherten 
Start- und Zielpositionen Führungsfunktionen nach Bild 4.35 generiert. Anstelle von 
Zeitfunktionen w(Ü wird häufig die Führungsgröße w als Funktion des Abstands der 
Regelgröße x von der Startposition (Anfahren) bzw. von der Zielposition (Abbremsen) 
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vorgegeben. Zweckmäßiger weise erfolgt die Bestimmung des aktuellen Wertes von w 
nicht durch ständige numerische Berechnung, sondern (besonders für Anlauf und Brem¬ 
sen) durch abgespeicherte Tabellenwerte (z.B. Bremsen: Differenz Zielposition X2 - 
Istwert :x: adressiert eine Speicherzelle, in der der zugehörige Wert für w steht). 



Bild 4.35 

Geeignete Führungsgrößenverläufe für 
Positioniervorgänge 


Überführungsfunktionen nach Bild 4.35 b sichern ein besonders weiches Anfahren und 
Abbremsen, da keine Beschleunigungssprünge in der Führungsgrößenvorgabe auftreten. 
Sie sind besonders für Antriebe hoher Massenbelastung zur Vermeidung unzulässig 
großer Reaktionskräfte günstig anzuwenden (Reaktionskräfte wirken als Störkräfte auf 
die übrigen Antriebe der kinematischen Kette.) Eine besonders gute Führung mit einer in 
der gesamten Bewegungsphase definierten Maximalabweichung ist dann gegeben, wenn 



Bild 4.36 

Führungsgrößen- und Istwertverläufe 

a) der Antrieb kann der FührungsgröOe folgen ; 

b) der Antrieb kann der Führungsgrößc nicht 
mehr folgen {Xy, > Xy^^öi Führungsgrößen- 
stop bei Xy, > Xy, ^„1 


die Regelabweichung ständig überwacht upd im Fall der Überschreitung eines vor¬ 
gegebenen Grenzwerts xr^^zui eine Veränderung der Führungsgröße nicht mehr zugelassen 
wird (dw/dt = 0). Somit stellt sich selbsttätig jene Zeitdehnung im Führungsgrößen¬ 
verlauf ein, die notwendig ist, damit der Antrieb sich innerhalb eines vorgegebenen Fehler- 
schlauchs bewegt. Diese Start-Stop-Funktion der Führungsgröße muß mit hoher Fre¬ 
quenz erfolgen, damit keine ruckartigen Bewegungen am Antrieb auftreten (kleine Ab¬ 
tastzeiten). Bild 4.36 zeigt die Wirkungsweise dieses Prinzips während eines Positionier¬ 
vorgangs von XI nach X2. 


4.4.4. Beispiel einer digitalen Lageregelung 

Am Beispiel einer Positionieraufgabe mit elektrohydraulischer Servoregelung soll eine 
mögliche Realisierungsvariante aufgezeigt werden. Einleitend sei bemerkt, daß es keine 
geschlossene Theorie oder Projektierungsrichtlinie zur gerätetechnischen Auslegung und 
zu wählenden Regelkreisstruktur bzw. -dimensionierung für digitale Antriebsregelungen 
gibt. Nachfolgende Ausführungen können deshalb nur Teilprobleme (und im Rahmen 
dieses Buches überwiegend nur qualitativ) darlegen. 
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Der vorliegende Antrieb besteht aus hydraulischem Arbeitszylinder Pl-50/22x400 
TGL 10901 (Kolbenfläche 15,8 cm^), zweistufigem elektrohydraulischem Servoventil 
TGL 33649 (Nenngröße = 25 dm^/min. Zeitkonstante druck- und aussteuerungs¬ 
abhängig Tsv ~ 3 ...4ms) und inkrementalem Meßsystem IGR (in Verbindung mit 
Ritzel-Zahnstange: Meßgliedauflösung 10 fxm). Der Betriebsdruck betrage Po = 6 MPa. 
Vom Antrieb ist eine Masse w ä 150 kg horizontal zu bewegen. Es treten Belastungs¬ 
kräfte von F ä; 2000 N auf. 

Vor Festlegung von Steuerstrategie und Reglerstruktur werden einige Teilprobleme 
unter besonderer Berücksichtigung der Eigenschaften elektrohydraulischer Antriebe be¬ 
trachtet. 


Eigenschaften des hydraulischen Antriebs 

Der elektrohydraulische Antrieb hat eine ausgeprägt nachgiebige statische Kennlinie 
X = f{F). Die Abhängigkeit der Geschwindigkeit x von der Belastung F und dem An- 
steuerström i berechnet sich für Arbeitszylinder mit einem Kolbenflächenverhältnis 
cp = A 1 IA 2 = 1 zu 



G turbulenter Leitwert eines Steuerspalts 

Q„ Servoventilnenngröße (maximaler Ölstrom bei Kurzschluß der gesteuerten Leitungen und einem 
Druckabfall Ap = 3,5 MPa über jedem Steuerspalt, d.h. p* = 1 MPa über dem gesamten Ventil). 

Nach Gl. (4.95) besteht bei veränderlicher Belastung keine Proportionalität zwischen 
Steuerstrom i und Geschwindigkeit x (Bild 4.37). Diese Eigenschaft, gepaart mit den 
Problemen bei der Erfassung niedriger Geschwindigkeiten (vgl. Abschn. 3.4.4. - Stell- 



Bild4.37 

Statisches Kennlinienfeld des Servoantriebs (Beispiel) 


Servoventil* Arbeitszylinder 

elektr. Verstärker _ __ 



Bild 4.38. Bei Aufschaltung einer stetigen Wegfunktion liegt eine Geschwindigkeitsregelung vor 

8 Industrierobotersteuerung 
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gliedgreift i.allg. ohne zusätzliche Getriebe am zu bewegenden Objekt an), macht einen 
direkten unterlagerten Geschwindigkeitsregelkreis (wie meist bei elektrischen Antrieben) 
nicht möglich. Zur definierten Führung bei veränderlichen Belastungen ist eine quasi¬ 
stetige Führungsfunktion erforderlich. Bild 4.38 zeigt am Beispiel einer angelegten 
Rampenfunktion w{t) = VqI, daß unter diesen Bedingungen eine Geschwindigkeits¬ 
regelung (I-Regler) vorliegt, ohne daß dabei die Geschwindigkeit explizit gemessen wird. 

Hydraulische Antriebe sind durch eine hohe Energiedichte charakterisiert. Obwohl der 
Druckaufbau in den Zylinderräumen (und damit die Kraftentwicklung) durch Öl¬ 
kompressibilität und Drosselung in den Steuerspalten des Servoventils verzögert erfolgt 
(RC-Glieder), werden beträchtliche Beschleunigungswerte erreicht. Dagegen nimmt das 
Beschleunigungsvermögen mit wachsender Antriebsgeschwindigkeit erheblich ab. (Struk¬ 
tur entspricht etwa einem E-Motor mit Drehzahlstellung mittels Vorwiderstand.) 




0 6 12 18 cms-' 2‘t 




Bild 4.40 

Maximalbeschleunigung x = f(x), 
Parameter F für betrachtetes Beispiel 


Für Antriebe mit tp = 1 sind unter Vernachlässigung der Servoventilzeitkonstante ^sv 
im Bild 4.39 normierte Grenzbeschleunigungen in Abhängigkeit von Geschwindig¬ 
keit X und Belastung F dargestellt (Analogrechnerergebnisse mit nichtlinearem Modell). 
Die Originalgrößen für vorliegende Regelstrecke lassen sich daraus ermitteln (Bild 4.40). 
Bei Anlauf (x = 0) und Gegenkräften von 2000 N wird x^ax ~ 34 m/s^ erreicht. Das 
entspricht bei w = 150 kg Reaktionskräften von etwa 5000 N auf das Antriebsgestell. 
Bei 70% der Maximalgeschwindigkeit und 50% der möglichen Maximalkraft hingegen 
ist der Antrieb überhaupt nicht mehr beschleunigungsfähig. Dieser Sachverhalt ist bei 
der Vorgabe der Führungsgrößen unbedingt zu berücksichtigen. 
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Modell für Regelstrecke 

Unter Berücksichtigung der Ölkompressibilität (sie ist aus praktischen Erfahrungen für 
eine wirklichkeitsnahe Modellierung kaum zu vernachlässigen) gilt in Näherung das 
linearisierte Modell gemäß Abschn. 4.2.4. Das Servoventil ist als Pri-Glied hinreichend 
genau zu beschreiben: 


x(p) _ Ksy _ C/A _1_ 

yip) 1 + TsvP 1 + 2D7> + T^p^ p 


Wesentlich ist, zu wissen, daß sich die ZeitkonstanteT über dem Kolbenhub verändert 
und die Dämpfung D in Abhängigkeit von der Ventilaussteuerung um Größenordnungen 
schwanken kann. 

Die maximale Zeitkonstante T (konstante Masse vorausgesetzt) tritt bei 99 = 1 in 
Kolbenmittelstellung auf: 


T = 



(4.97) 


ß Kompressibilitätsfaktor des Öles etwa 8 ... 10 • 10 MPa \ 
Die Gesamtdämpfung D 


D — Djn + Dyy 


^ <Pb + 2m . 

2A \ 2m 2A \ Vß ’ 


Ko Faktor der geschwindigkeitsproportionalen Reibung 


(4.98) 


besteht aus zwei Anteilen. Während der mechanische Anteil annähernd konstant 
bleibt, verändert sich der hydraulische Anteil stark mit der Aussteuerung (starke Ver¬ 
minderung der Druckverstärkung E mit wachsender Aussteuerung). In der Position 
i 0 sind Gesamtdämpfungswerte D = 0,05 ... 0,1 keine Seltenheit. Für Stabilitäts¬ 
berechnungen und Reglerdimensionierung sind und D^^in innerhalb des Arbeits¬ 
bereichs zugrunde zu legen. 


Reglerstruktur 

Der Hydraulikantrieb greift wegen seiner großen Stellkräfte i.allg. unmittelbar ohne 
zwischengeschaltetes Getriebe am zu bewegenden Objekt an. Das hat zur Folge, daß 
Änderungen von Massenbelastungen am Roboter direkt in die Zeitkonstanten der Strecke 
eingehen, während bei Elektroantrieben eine Masseänderung mit dem Faktor Ijü^ am 
Motor wirksam wird {ü Getriebeübersetzungsverhältnis). Damit ist der Variationsbereich 
der Regelstreckenparameter u. U. im Arbeitsbereich relativ groß (ausgeprägt bei Robotern 
in Gelenkbauweise). Wird mit festen Reglereinstellwerten gearbeitet (das ist z. Z. die über¬ 
wiegende Ausführung), dann sind zur Sicherung der Stabilität die Reglerparameter dem 
ungünstigsten Arbeitspunkt anzupassen. Damit wird in anderen Arbeitspunkten auf eine 
dort vorhandene Reserve an dynamischer und statischer Güte verzichtet. Die Möglichkeit 
einer Parameterverstellung (z. B. von der Information „Werkstück gegriffen“ oder „Ex¬ 
tremstellung anderer Antriebe“) sollte genutzt werden, wobei eine sprungförmige Ver¬ 
stellung nicht in der Bewegungsphase vorzunehmen ist (ruckartige Bewegungen). Für 
eine exakte Positionierung ist ein integraler Anteil im Regler unumgänglich. Ein durch¬ 
gängig wirksamer I-Anteil führt zu einem strukturbestimmten Überschwingen und ge¬ 
stattet kein Überschwingfreies Einlaufen in die Position. Es ist deshalb nur in der Um¬ 
gebung der Position zuzuschalten bzw. in der Bewegungsphase zu begrenzen. Im Zu- 
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sammenhang mit der Ölkompressibilität und der Reibungscharakteristik zu bewegender 
Objekte (Bild 4.41) hat der I-Anteil eine weitere ungünstige Eigenschaft. Liegt eine 
Positionsabweichung vor, wird die Regelabweichung so lange aufintegriert, bis die Stell¬ 
größe ausreicht, die Haftreibung zu überwinden. Bei einsetzender Bewegung entspannt 
sich die Ölsäule, und die degressive Reibkennlinie (geringere Gegenkräfte bei x >0) 
läßt den Antrieb über die Position hinausschwingen. Der Vorgang vollzieht sich in Gegen¬ 
richtung in gleicher Weise, was zum ständigen Schwingen mit niedriger Frequenz um die 
Position führt, falls der Antrieb nicht „zufällig“ in der Reibungshysterese zum Stehen 



Bild 4.41 

Typische Reibcharakteristik Fr = f{x) von Verbrauchern 


kommt. Häufig hilft nur eine Unempfindlichkeitszone im I-Anteil, innerhalb der die 
I-Komponente abgeschaltet wird, was zwangsläufig zu einem höheren Positionierfehler 
führt. (Die erreichbare Genauigkeit wird nicht mehr durch die Meßgliedauflösung be¬ 
stimmt.) D-Anteile im Regler bewirken eine Stabilisierung des Regelkreises bzw. eine 
stärkere Bewertung von Führungsgrößenänderungen. Wegen der kleinen Dämpfungs¬ 
werte elektrohydraulischer Antriebe steht der erstgenannte Aspekt meist im Vorder¬ 
grund, so daß es häufig günstiger ist, nur die Regelgröße anstelle der gesamten Regel¬ 
abweichung differentiell zurückzuführen. Da die direkte Messung der Istgeschwindigkeit 
am Hydraulikantrieb nicht möglich ist (i: = dx/dr), ist die D-Rückführung durch 
numerische Differentiation - bewertete Differenz (x^ — x^_i)ltab - zu bilden. Zur Ein¬ 
haltung der für einen wirksamen D-Anteil notwendigen Phasenbeziehungen ist eine 
kleine Abtastzeit erforderlich. Bei Antrieben kleiner Zeitkonstanten bedeutet dies, daß 
(abhängig von der Meßgliedauflösung) zwischen zwei Tastzyklen nur kleine Istwert¬ 
differenzen auftreten. Diese müssen, um den D-Anteil zur Wirkung zu bringen, mit 
einem großen Faktor multipliziert werden, was zwangsläufig zu großen Quantisierungs¬ 
einheiten der Stellgröße führt. Dadurch kann u.U. sogar ein gegenteiliger Effekt, also 
eine Destabilisierung des Antriebs, eintreten. So konnte z.B. bei einem Antrieb (dominie¬ 
rende Zeitkonstante etwa 6 ms, Meßgliedauflösung 5 [zm) für Abtastzeiten = 0,3 bis 
10 ms keine Einstellung gefunden werden, die einen positiven Einfluß der D-Komponente 
erkennen ließ. 

Abtastfrequenz 

Prinzipiell gilt, daß ein Abtastsystem nur für den Grenzfall tab 0 die Qualitätsparameter 
eines entsprechenden analogen Regelkreises erreicht. Jedoch ist nachweisbar, daß ab 
einer bestimmten Grenze eine weitere Verringerung der Abtastzeit nur unwesentliche 
Verbesserungen zu erzielen sind. In [4.16] wird der Einfluß der Abtastzeit auf Stabilität, 
Bandbreite und Steuerbarkeit des Regelkreises abgeleitet. An dieser Stelle soll nur der 
Stabilitätseinfluß betrachtet werden. Im Bild 4.42 ist die Abhängigkeit der kritischen 
Kreisverstärkung (integraler Übertragungsfaktor des offenen Kreises) für vorliegende 
Regelstrecke mit P-Regler dargestellt (Grenzfall synchroner Abtastung). Die Berechnung 
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erfolgte über die Beschreibungsfunktion mit dem linearisierten Modell nach (Gl. 4.96) 
[4.15]. Die Maximalwerte der Kreisverstärkung werden, nahezu unabhängig von der 
Dämpfung, bei ~ 2,5 erreicht. Mit den Werten der Regelstrecke 

Kolbenfläche A = 15,8 cm^; Masse m = 150 kg; Volumen zwischen Kolben und 
Servoventil V = 500 cm^; Kompressibilitätsfaktor ß = % • lO“'^ MPa“^ 

ergibt sich nach Gl. (4.97) T ä 4 ms, woraus sich eine Abtastfrequenz von etwa 100 Hz 
(Abtastzeit = 10 nis) berechnet. An dieser Stelle des Diagramms (Bild 4.42) ist 
^Ikrit T’ ~ 0 ,48 ablesbar, woraus der Originalwert 

K,y,n = Jfsv — = .2^5. = 120 s- ■ 

A T 

zu bestimmen ist. Der ermittelte Wert kann als grober Richtwert angesehen werden (Ver¬ 
nachlässigungen im Modellansatz, systemeingeschränkte Gültigkeit der Beschreibungs¬ 
funktion). Die Einbeziehung coulombscher Reibung bewirkte im vorliegenden Beispiel 
eine Veränderung der kritischen Verstärkungswerte bis 30%, wobei diese bei hohen Tast¬ 
frequenzen wie eine Dämpfungserhöhung wirkte, während bei niedrigen Tastfrequenzen 
ein destabilisierender Effekt auftrat. 


Ausführungsvariante 

Bild 4.43 zeigt schematisch die gewählte Regelkreisstruktur mit Führungsgrößengenerator 
zur Vorgabe einer Sollwertfunktion mit sinoidischem Anfahr- und Abbremsvorgang 
(vgl. Bild 4.35b). Die angestrebte stationäre Verfahrgeschwindigkeit sei xTsou = Vq, die 
Maximalbeschleunigung x^ax = vorgegeben. Damit lauten die Gleichungen der zu 
generierenden Führungsfunktion h’(/): 


Anlauf 

\ • L • 2^Jo 

w{t) = bo sm cot = bo sm- t 


w{t) = — (1 — cos cot) = — (1 — cos A 
2 2 V Vq J 

w(r) = w(/o) + — (^t -I- — sin = w{to) + — (t - — 

2 \ CO J 2 V 2bo 


. 2bo ^ 
sm- 1 


stationäre Phase 
vv(r) = 0 

^(0 = Vq 

w{t) = w(ri) -I- voit) 
Abbremsen 

w(/) = —bo sin cot = —bo sin 


2bo 


H’(r) = ^1 + cos ^1 + cos 

w(t) = ^(02 + — (t -sincor^ = ^(^ 2 ) + — (t -sin 

2 \ CO J 2 \ 2bo Vo 


(4.99) 


(4.100) 


[ (4.101) 
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Maximalbeschleunigung Bq und -geschwindigkeit Vq sind in Übereinstimmung mit der 
Leistungsfähigkeit des Antriebs (Bild 4.40) festzulegen. Die Wegsollwerte Wi(t) können 
für die diskreten Zeiten nt^^, berechnet und als Tabelle abgespeichert werden. Der Über¬ 
gang von Gl. (4.99) auf Gl. (4.100) ist zwar eindeutig nach n Tastperioden mit 




(4.102) 



Bild 4.42 

Abhängigkeit der Stabilitäts¬ 
grenze von der Abtastzeit für 
ein Antriebsmodell nach 
Gl. (4.96) 

T^ylT = 1, P-Regler, synchrone 
Abtastung 


etektr. Verstärker* Serroventil Arbeifszylinder 



Aw-f(n) für Adressen n 

Bild 4.43. Signalflußbild eines Positionierantriebs mit Führungsgrößengenerator 

festgelegt, jedoch der Übergang von Gl. (4.100) auf Gl. (4.101) (Beginn des Abbremsens) 
ist unklar. Deshalb wird zweckmäßigerweise der je Tastintervall erforderliche Weg¬ 
zuwachs 


AWj = w(/2/ab) - W ((« - 1) fab) 


( 4 . 103 ) 















4.5. Adaptive Regelung 


119 


extern berechnet und abgespeichert. Diese Tabelle wird beim Anfahren aufwärts und 
nach Überschreiten der halben Positionsdifferenz |A;cl = |(X1—X2)/21 abwärts ab¬ 
gearbeitet, wobei im Rechner der jeweils aktuelle Führungsgrößenwert w («fab) 

n 

wC/zfab) = XI + X (4-104) 

i= 1 

berechnet wird. Im Bild 4.43 stellt das Glied ll diese Zuwachstabelle dar. Beim Start¬ 
signal zum Verfahren von XI nach X2 stehen die Komparatoren 13 und 14 in der ge¬ 
zeichneten Stellung. Je Tastintervall (symbolisiert durch die Impulsfolge am Glied 14) 
wird der Adressenzähler 12 für die Wegzuwachstabelle 11 erhöht und die Zuwachs¬ 
inkremente im Summator 10 zum aktuellen Führungsgrößenwert aufaddiert. Bei Über¬ 
schreitung des halben Verfahrwegs schaltet der Komparator 13 ptm; der Adressen¬ 
zähler 12 zählt abwärts, und Tabelle 11 wird bis zum Wert 0 abgearbeitet. Da i.allg. 


lAjcl = 1X1 - X2| + 2 X Awi 

i= 1 

ist, wird nach Abarbeiten der Tabelle über Komparator 9 die Zielposition X2 als letzter 
Lagesollwert am Regelkreiseingang wirksam. Geregelt wird in der Verfahrphase mit 
P-Regler (Glied 6), während in der Umgebung der Zielposition X2 ein I-Anteil (Glied 8) 
zugeschaltet wird. Sollte der Antrieb der berechneten Führungsgröße nicht mehr mit aus¬ 
reichender Genauigkeit folgen können (x^ > schaltet Komparator 14, wodurch 

ein weiterer Führungsgrößenzuwachs so lange nicht mehr erfolgt, bis Xh- wieder in den 
zulässigen Toleranzbereich eingelaufen ist. 



Bild 4.44 

Oszillografierte Übergangs¬ 
funktionen 


Diese Struktur, die im Detail weitere Nuancen zuläßt, erfordert für ihre Implementie¬ 
rung auf einem Mikrorechner Kl 520 etwa 1,2 kByte Speicherkapazität. Die Programm¬ 
abarbeitungszeit beträgt etwa 0,8 ms. Bild 4.44 zeigt am praktischen System oszillo¬ 
grafierte Übergangsfunktionen. 


4.5. Adaptive Regelung 

Ändern sich die Parameter der Regelstrecke in nicht vorhersehbarer Weise, sind zur 
Erreichung vorgegebener Gütekriterien adaptive Regelverfahren notwendig. Die Theorie 
der adaptiven Regelung ist erst in jüngster Zeit durch grundlegende Arbeiten von 
Zypkin [4.17], Bellmann [4.18], Astroem [4.19] und Feldbaum [4.20] soweit entwickelt 
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worden, daß praktische Einsatzfälle realisiert werden können; das betrifft insbesondere 
Stabilitätsprobleme und die erforderlichen Verfahren zur Identifikation und Parameter¬ 
schätzung. 

Adaptive Regelverfahren lassen sich grob in zwei Gruppen einteilen: 

Die erste Methode beruht auf der Nutzung eines Referenzmodells und wird als MRAC 
(model reference adaptive control) bezeichnet. Bild 4.45 zeigt schematisch das Prinzip. 
Die Eingangsgröße wird einem parallel zur Regelstrecke liegenden Modell zugeführt; 
dieses Referenzmodell enthält den determinierten Teil der Regelstrecke. Die durch 
Parameteränderungen hervorgerufenen Abweichungen der zu regelnden Prozeßwerte 
werden durch Vergleich mit dem Ausgangssignal des Referenzmodells ermittelt und 
steuern die Einstellung der Regelparameter so, daß die Abweichungen zwischen Modell¬ 
und Prozeßausgang eliminiert werden. Auf die unterschiedlichen Methoden zur Er¬ 
mittlung der Regelparameter soll hier nicht eingegangen werden; sie sind in [4.21] aus¬ 
führlich dargestellt. Die Anwendung dieses Verfahrens zur Lageregelung der Roboter¬ 
achsen beinhaltet somit die Nutzung des dynamischen Modells, das bis auf stochastische 
Reibungsanteile und im Greifer befindliche Massen oder am Effektor angreifende äußere 
Kräfte grundsätzlich bekannt ist. Um den zur Implementierung des Modells erforder¬ 
lichen Aufwand zu reduzieren, ist es aber auch denkbar, das Referenzmodell abzu¬ 
rüsten, z.B. durch Vernachlässigung der geschwindigkeitsabhängigen Terme in Gl. (4.5), 
und nur die zustandsabhängigen Anteile einzubeziehen. Die vernachlässigten Terme 
werden dann als äußere Störungen aufgefaßt. Dies bedeutet aber erhöhte Anforderungen 
an das Zeitverhalten der Parameterbestimmung. 



Bild 4.45. Adaptive Regelung mit Referenzmodell Bild 4.46. Selbsteinstellendes Regelungssystem 


Eine konsequente Weiterführung der Vernachlässigungen führt zur zweiten Methode 
der adaptiven Regelung, den selbsteinstellenden Verfahren STUR (jelf tumng regulation). 
Das Prinzip ist im Bild 4.46 dargestellt. Durch Parameterschätzung werden aus den 
Steuersignalen u{t) und der Regelgröße Parameter der Regelstrecke ermittelt, die das 
Verhalten eines linearen Reglers modifizieren. Wendet man diese Methode auf die Lage¬ 
regelung der Roboterachsen an, müssen insbesondere zeitliche Forderungen an die 
Parameterschätzung erfüllt werden. Die Änderungsgeschwindigkeit der dynamischen 
Parameter des Manipulators bestimmt das notwendige Konvergenzverhalten der Schätz¬ 
algorithmen. 

Mit wenig Aufwand realisierbare Verfahren sind möglich, wenn vereinfachende Vor¬ 
aussetzungen über die Änderungen der Regelstrecke und die Möglichkeiten der Identi- 
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fikation getroffen werden können. Hierzu sollen nachfolgend zwei Beispiele diskutiert 
werden, bei denen eine Adaption bezüglich der durch im Greifer befindliche Massen her¬ 
vorgerufenen Änderungen der Trägheitsmomente erfolgt. 

Der Einfluß des Trägheitsmoments auf die Gesamtübertragungsfunktion des Regel¬ 
kreises mit unterlagerter Geschwindigkeitsregelung wird mit den im Abschnitt 4.3.2. 
angenommenen P-Reglern gemäß (4.83) bei Vernachlässigung der Reibung zu 


G{p) = 


X{p) 

W{p) 


+ pK^Kj^ + KxKm 


(4.105) 


Jg Gesamtträgheitsmoment der Achse. 



Identifikation von Jg Gesch windigkeitsregelung 

Jg Schätzgröße 


Die Struktur wird im Bild 4.47 gezeigt. Ist Jm das Eigenträgheitsmoment des Antriebs, 
läßt sich dies auf die Achse umrechnen mittels 

J^ — J “I“ J , 
a Getriebeübersetzungsfaktor. 

Die Variation der Trägheitsmomente führt zu einer Variation der mechanischen Reso¬ 
nanzfrequenz des Systems. Es gilt 


a)„ = (ßr 


Jo 


wenn Mq die Resonanzfrequenz beim Nennträgheitsmoment Jq ist. 

Gl. (4.105) stellt die Übertragungsfunktion eines Systems 2. Ordnung 


G{p) = 


1 


P^ -h Ißcop + (JO^ 

mit der charakteristischen Frequenz m und dem Dämpfungsfaktor ß dar. 

Ik^K^ . K.,K^ 


(O = 


ß = 




(4.106) 


(4.107) 


(4.108) 
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Zur Vermeidung mechanischer Schwingungen muß die Regelung so ausgelegt werden, 
daß oi « 0,5 (Um. Die kürzesten Übergangszeiten werden für ß = \ erreicht. Damit wird 

= 2^J.K,K„. (4.109) 

Um sowohl Überschwingen der Positionsendwerte als auch mechanische Schwingungen 
zu vermeiden, muß also gelten 



d.h., der maximale Wert von wird 


Bei der praktischen Auslegung von Lageregelkreisen wird diese Bedingung oft nicht ein¬ 
gehalten, um kürzere Positionierzeiten zu erreichen. Ein geringes Überschwingen wird 
dabei bewußt in Kauf genommen. 

Äquivalente Beziehungen gelten für die Massenabhängigkeit bei Schubachsen. 

Aus Gl. (4.109) läßt sich die kritische Dämpfung für das Trägheitsmoment Jg durch 
entsprechende Wahl des Verstärkungsfaktors für die Geschwindigkeitsrückkopplung be¬ 
stimmen. Geschieht dies für das maximal auftretende Trägheitsmoment, wird zwar das 
Überschwingen vermieden; die Positionierzeiten bei geringerer Belastung werden jedoch 
vergrößert. Optimale Positionierzeiten werden erreicht, wenn K^, dem momentanen 
Trägheitsmoment entsprechend berechnet wird. Dabei kann die Rückkopplungs¬ 
verstärkung gemäß 




(4.110) 


aus der Lastvariation bestimmt werden. Das kann wie im Bild 4.47 durch Auswertung 
der Stellgröße u und der Beschleunigung x erfolgen. Aus der zugrunde liegenden Be¬ 
wegungsgleichung 


JgX = K^u (4.111) 

läßt sich durch Umstellen nach Jg ein Schätzwert Jg ermitteln; damit kann gemäß 
(4.110) ständig nachgestellt werden. Offenbar ist dieses Verfahren nur anwendbar, wenn 
der Drehzahlregelkreis im linearen Bereich arbeitet. 

Mit dem dargestellten Verfahren ist es prinzipiell auch möglich, mehrere gekoppelte 
Achsen unabhängig voneinander adaptiv zu regeln, d.h., die Parameter an die zu- 



0 0.1 0,2 Q3 0,4 0,5 0,6 0,1 0,8 S 1,0 0 0,5 s 1,0 

al b) 

Bild 4.48. Drehzahl und Verfahrwinkel bei zeitoptimalem Regler mit der Lastvariation r als Parameter 
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standsabhängigen Trägheitsmomente und die auftretenden Koppelkräfte anzupassen. 
Hierbei können jedoch Stabilitätsprobleme auftauchen. 

Kommt gemäß Abschnitt 4.4.1. ein zeitoptimaler Regler zur Anwendung, besteht das 
Problem der Adaption darin, bei variabler Last die Umschaltpunkte zwischen Beschleu¬ 
nigen und Abbremsen zu bestimmen. Bild 4.48 zeigt den zeitlichen Verlauf der Drehzahl 
und des Verfahrwinkels bei der Lastvariation t. 



Bild 4.49. Drehzahlverlauf bei beschränkter Bild 4.50. Führungsgröße zur angenähert 

Ableitung der Steuergröße (nach [4.8]) zeitoptimalen Regelung (nach [4.8]) 


Bei beschränkter erster Ableitung der Steuergröße ergibt sich der im Bild 4.49 darge¬ 
stellte Verlauf der Winkelgeschwindigkeit. In diesem Fall ist ein angenähert zeitoptimales 
Verfahren möglich, wenn gemäß Bild 4.50 eine Führungsgröße erzeugt wird, die das 
rechtzeitige Einsetzen der Bremsphase sichert. Ein entsprechender Algorithmus wird in 
[4.8] beschrieben. 

Beim zeitoptimalen Positionieren wird davon ausgegangen, daß sich die Trägheits¬ 
momente während des Verfahrens nicht ändern. Die durch Verkopplungen auftretenden 
Variationen können damit nicht berücksichtigt werden. Es kann nur eine Adaption an 
die durch äußere Belastung des Manipulators bedingten Parameteränderungen erfolgen. 
Zur Identifikation der Belastung sind unterschiedliche Verfahren geeignet. Die direkte 
Messung durch Kraft-Moment-Sensoren ist im Abschnitt 7. dargestellt. Eine einfache 
Identifikation aus der Regelabweichung ist möglich, wenn sie innerhalb einer Phase 
konstanter Beschleunigung erfolgt. 


4.6. Bahnsteuerung 

Die Steuerung des Endeffektors (Werkzeug, Greifer) auf einer vorgegebenen Raum¬ 
kurve erfordert im allgemeinen Fall die Koordinierung der einzelnen Bewegungsachsen 
und wird mithin eine Steuerung mit Bahnverhalten. 

Nach der Art der Führungsgrößenerzeugung lassen sich solche Steuerungen unter¬ 
teilen in 

- Multipunktsteuerungen, die die Führungsgrößen als Sollwertfolge vollständig in einem 
Programmierlauf während der Bewegung des Grundgeräts oder eines Hilfsgeräts auf¬ 
nehmen und abspeichern; 

- Bahnsteuerungen, die die Führungsgrößen durch Berechnung einer Raumkurve er¬ 
zeugen, deren charakteristische Werte in die Steuerung eingegeben und abgespeichert 
werden. 

Die Führungsgrößen werden dabei in beiden Fällen so schnell an die Lageregelkreise 
ausgegeben, daß aufgrund der dynamischen Eigenschaften der Antriebe und der an- 
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getriebenen Achse ein kontinuierlicher Bewegungsverlauf erreicht wird (Folgeregelung). 
Bahnsteuerungen sind Voraussetzung für den Einsatz von Industrierobotern beim Farb¬ 
spritzen, Lichtbogenschweißen, Entgraten und ähnlichen technologischen Aufgaben. 

Haupteinsatzgebiet für Multipunktsteuerungen sind hydraulisch angetriebene Robo¬ 
ter, die durch Freischalten der Antriebe leicht bewegt und Sollwerte von Bahnkurven im 
direkten Teach-in erstellt werden können. 

Das Erzeugen einer Sollwertfolge im indirekten Teach-in erfordert die Ansteuerung 
aller Raumpunkte mit der für die Folgeregelung notwendigen Auflösung und ist sehr 
zeitaufwendig. 

Reduziert man die Anzahl der Bahnstützpunkte, muß in geeigneter Weise interpoliert 
werden. Die Interpolation kann dabei Zwischenwerte der Sollwertfolge einzelner Achsen 
aus den gespeicherten Positionswerten dieser Achse oder Zwischenwerte einer in natür¬ 
lichen Koordinaten vorliegenden Raumkurve aus deren analytischer Darstellung er¬ 
zeugen. 

Im zweiten Fall ist zur Erzeugung einer Sollwertfolge für die Lageregelkreise die Um¬ 
rechnung der in natürlichen Koordinaten vorliegenden Interpolationswerte in das achs- 
spezifische Koordinatensystem erforderlich. Die Lösung dieser Koordinatentrans¬ 
formation - auch als inverses kinematisches Problem bekannt - ist für Industrieroboter 
mit einer Anzahl von Freiheitsgraden « > 3, insbesondere bei rotatorischen Achsen, mit 
hohem rechentechnischem Aufwand verbunden. 

Die Koordinatentransformation bildet gleichzeitig eine notwendige Voraussetzung 
für die Steuerung nach Sensordaten, die in natürlichen Koordinaten erfaßt werden. 

Handhabungsaufgaben, bei denen ein Werkzeug auf einer durch den technologischen 
Bearbeitungsprozeß vorgegebenen Bahn geführt wird, erfordern neben der Positionie¬ 
rung auch eine Orientierung des Werkzeugs. Eine durch das Werkzeug gelegte Gerade 
ist in einem durch den Bearbeitungsvorgang gegebenen funktionalen Zusammenhang 
mit der Positionierung zu führen. 

Die allgemeine Lösung dieser Aufgabe erfordert sechs Freiheitsgrade des mechani¬ 
schen Systems, da Positionierung und Orientierung durch sechs voneinander unabhän¬ 
gige Variable beschrieben werden. Mit Einschränkungen für die Orientierung sind auch 
Systeme mit fünf Freiheitsgraden einsetzbar. 

Bahnsteuerungen werden nicht nur aus technologischen Forderungen eingesetzt; sie 
verbessern auch die Einsatzparameter für Punkt-zu-Punkt-Bewegungen. Insbesondere 
sind zu nennen: 

- Verkürzung der Positionierzeiten durch gleichzeitige Bewegung aller Achsen, 

- Verringerung der am gegriffenen Werkstück auftretenden Kräfte während der Be¬ 
wegung durch kontinuierliche Geschwindigkeitsverläufe, 

- Einsparung des spezifischen Energieverbrauchs durch eine geringere Anzahl von Be¬ 
schleunigungsphasen . 

Bahnsteuerungen erfordern neben einem höheren rechentechnischen Aufwand eine 
größere Leistungsreserve bei der Auslegung der Primärenergiewandlung (Hydraulik¬ 
pumpe, Netzteile) für gleichzeitige schnelle Bewegungen mehrerer Antriebe. 

4.6.1. Bahnsteuerverfahren bei Multipunktsteuerimgen 

Multipunktsteuerungen werden im direkten Teach-in programmiert. Dabei gelangen in 
der Programmierungsphase (Teach-in) die im zeitlichen Rhythmus abgetasteten und in 
Digitalgrößen umgewandelten Achspositionen in der Reihenfolge ihres zeitlichen Ein- 
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treffens in den Speicher der Steuerung. In der Arbeitsphase (Playback) werden diese 
Positionswerte in der gleichen Reihenfolge aus dem Arbeitsspeicher ausgelesen und den 
Servoreglern als Sollwerte zugeführt. Dabei entstehen während der Programmierphase 
im Prinzip Wertetabellen für die Positionszeitverläufe aller Achsen im Arbeitsspeicher, 
wobei die Zeitvariable in der Regel durch die ständig weiterzählende Adresse repräsen¬ 
tiert wird (Bild 4.51). 



Bild 4.51 

Prinzip der Bahnkurvenabspeicherung 
und -erzeugung bei einer Multipunkt¬ 
steuerung 


Bei Multipunktsteuerungen bedingen die Forderungen nach Präzision und Qualität 
der Bewegungen zusammen mit den Zeitkonstanten der Servoregler relativ hohe Takt¬ 
frequenzen der Sollwertvorgaben (typisch 80 Hz), was bei der direkten Speicherung aller 
Positionswerte zu einem beträchtlichen Speicherplatzbedarf für technologisch relevante 
Programmlaufzeiten führt. Bild 4.52 zeigt dazu die Abhängigkeit des Speicherplatz¬ 
bedarfs von der Abtastfrequenz und der technologischen Programmlaufzeit für einen 



Abfasffreguenz 


Bild 4.52 

Speicherplatzbedarf bei einer einfachen Multipunkt¬ 
steuerung in Abhängigkeit von der Abtastfrequenz und 
der Programmdauer (öachsiger Industrieroboter, 
Speicherwortbreite 2 byte je Achsposition) 


öachsigen Roboter, wobei je Positionswert eine Speicherwortbreite von 2 byte vorgesehen 
ist. Man erkennt, daß bei einer Abtastfrequenz von beispielsweise 50 Hz bereits einige 
Minuten Programmlaufzeit Speicher von 100 kbyte und mehr erfordern. Deshalb finden 
in einigen Multipunktsteuerungen Massenspeicher mit seriellem Zugriff (Magnetband, 
Floppy-Disc [4.22] [4.24]) als Arbeitsspeicher Verwendung. Jedoch erscheint aufgrund der 
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höheren Betriebszuverlässigkeit und der Möglichkeiten effektiverer Programmorgani¬ 
sation auch der Einsatz von Halbleiterarbeitsspeichern als wünschenswert. Die Programm¬ 
archivierung und die Speicherung längerer Programme können dann mit einem sekun¬ 
dären Massenspeicher erfolgen, der aber weit weniger beansprucht wird als bei einem 
Einsatz als Operativspeicher der Steuerung. 

Zur Senkung des Speicherplatzbedarfs bei gleicher Programmdauer bzw. zur Erhöhung 
der Programmdauer bei vorgegebenem Speicherumfang ist es sinnvoll, Verfahren zur 
Datenkompression vor der Abspeicherung in der Teach-in-Phase anzuwenden. Bei der 
Programmwiedergabe (Playback) ist dann das jeweils inverse Verfahren der Daten¬ 
dekompression anzuwenden. Dadurch entsteht das prinzipielle Verarbeitungsschema 
nach Bild 4.53. Dargestellt ist die Verarbeitung bei einer Achse. Nach der Abtastung und 
Digitalisierung der Eingangspositionswerte im Analog-Digital-Umsetzer ADU erfolgt 
eine Datenverdichtung mit dem Ziel einer effektiven Abspeicherung. Bei der Wiedergabe 
werden die Daten dekomprimiert und mit dem Digital-Analog-Umsetzer DAU in ein 
stufenförmiges Zeitsignal umgewandelt. Die endgültige Glättung erfolgt durch Träg¬ 
heiten in den Servoregelkreisen. Das Verarbeitungsschema ist dem der digitalen Informa¬ 
tionsübertragung sehr ähnlich, nur tritt dort an die Stelle des Arbeitsspeichers der Über¬ 
tragungskanal. Deshalb sind die zum Einsatz kommenden Signalverarbeitungsverfahren 
mit denen der Übertragungstechnik verwandt bzw. direkt von dort übernommen (siehe 
unten). 


Teach - in 


Playback 



Bild 4.53. Signalverarbeitung in einer Multipunktsteuerung 
ADU Analog-Digital-Umsetzer; £>.41/Digital-Analog-Umsetzer 


Bei der Datenkompression sind Verfahren zur Reduzierung der Speichertiefe und der 
Speicherwortbreite zu unterscheiden. 

In der ersten Gruppe wird das Ziel verfolgt, sowenig wie möglich Positionen abzu¬ 
speichern. Das ist 

- durch eine reduzierte Abtastfrequenz beim Teach-in und einer Interpolation beim 
Playback oder 

- durch eine adaptive Steuerung der Abtastfrequenz entsprechend der aktuellen Prozeß¬ 
dynamik. 

erreichbar. 

Die zweite Gruppe von Verfahren geht davon aus, daß sich der Roboter stets mit be¬ 
grenzter Geschwindigkeit und begrenzter Beschleunigung bewegt und deshalb Positions¬ 
sprünge nicht auftreten können. Deshalb genügt es, verkürzte Informationen über auf¬ 
einanderfolgende Positionswerte aufzuzeichnen. Mögliche Verfahren sind hier das Vor¬ 
hersageverfahren und die Anwendung der Deltamodulation. 

Die genannten Verfahren sollen im folgenden kurz vorgestellt werden. 
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Zur Ermittlung der erforderlichen Abtastfrequenz bei der Aufnahme ist das Spektrum 
des abzutastenden Signals von Bedeutung. Bild 4.54 zeigt dazu’ Leistungsdichtespektren 
der Bewegung einer relativ langsamen Grundachse 1 und einer schnelleren Handachse 2 



/■— 


Bild 4.54. Leistungsspektrum der Achsbewegungen beim Farbspritzen 

(T) für eine Grundachse [4.28]; @ für eine Handachse [4.28]; (j) Spektrum nach [4.27] 


Zum Vergleich ist ein Leistungsdichtespektrum eingezeichnet, das in [4.27] zum Test 
von Datenkompressionsmethoden verwendet wurde. Die Spektren lassen sich erfahrungs¬ 
gemäß recht gut durch Ausdrücke der Form 


S{f) = 


(1 + + a2f*) (1 + a^p + aj*) 


(4.112) 


mit passend gewählten ; / = 1 bis 4 approximieren. 



x(m-1,0) 
X (m-11) 
xim-1,2) 
x(m,0) 
x(m,1) 

X (m,Z) 
x(m+l,0) 


Bild 4.55 

Arbeitsschema eines Interpolators 


ist ein Störspektrum, das in Näherung als konstant angenommen werden kann und 
etwa 70 dB unter 5'(0) liegt. Man erkennt aus Bild 4.54, daß die Spektren bei Frequenzen 
von 10 bis 20 Hz in das Rauschen übergehen, woraus sich nach dem Abtasttheorem eine 
minimale Abtastfrequenz im Bereich von 20 bis 40 Hz für eine vollständige Rekonstruk- 
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tion des Ausgangssignals aus den Abtastwerten ergibt. Da in der Praxis immer gewisse 
Rekonstruktionsfehler zugelassen sind, kann mit noch geringeren Abtastfrequenzen ge¬ 
arbeitet werden (s. unten). 

Da die Servoregelkreise Abtastfrequenzen von 50 bis 80 Hz für die Sollwertvorgabe 
erfordern, müssen Zwischenwerte zwischen den abgespeicherten Stützwerten bei der 
Wiedergabe ermittelt und eingefügt werden. Dies leistet der Interpolator, eine Funktions¬ 
gruppe, die heute vorwiegend programmtechnisch in einem Steuerrechner oder mit einem 
Spezialrechner innerhalb der Robotersteuerung realisiert wird. Ihre grundsätzliche Wir¬ 
kungsweise ist im Bild 4.55 dargestellt. Der Interpolator liest eine bestimmte Anzahl 
(2 bis 5) aufeinanderfolgende Stützwerte aus dem Arbeitsspeicher aus, berechnet daraus 
die erforderliche Anzahl von Zwischenwerten und gibt diese an die Servoregler aus. Er 
arbeitet sich so Intervall für Intervall in Richtung zunehmender Zeit durch den Arbeits¬ 
speicher hindurch, wobei zweckmäßig die einzelnen Achsen zyklisch durch das gleiche 
Interpolationsprogramm bedient werden. 


x(i) 




bl 

Bild 4.56. Linearinterpolation 

a) Stützwerte und Zwischenwerte; b) Gewichtsfunktion eines Linear¬ 
interpolators; c) Algorithmus der Linearinterpolation 



Interwall¬ 

wechsel 


Zwischenwert¬ 

berechnung 


Am Beispiel der Linearinterpolation soll die Wirkungsweise genauer dargestellt wer¬ 
den. Im Bild 4.56a sind dazu die Stützwerte aus dem Arbeitsspeicher dick, die zu inter¬ 
polierenden Zwischenwerte dünner gezeichnet; m ist dabei die laufende Nummer des 
Stützwertes, n die laufende Nummer des Zwischenwerts. Sollen N Zwischenwerte zwi¬ 
schen zwei Stützwerten eingefügt werden, so berechnen sie sich nach 

f 1 - —^ + a: (m -h 1) —. 

\ n) N 


X (m, n) = x(m) 


(4.113) 
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Ein Algorithmus, der diese Formel berechnet, ist im Bild 4,56 c dargestellt. Er zeigt den 
typischen Aufbau vieler Interpolationsalgorithmen. In der inneren Schleife werden auf¬ 
einanderfolgend die Zwischenwerte eines Intervalls berechnet, während beim Übergang 
zum nächsten Intervall eine Vorbereitungsrechnung für die nächsten N Zwischenwerte 
(hier nur die Ermittlung von Ax) ausgeführt werden muß. Wählt man für N eine Potenz 
von 2, dann bedeutet die Division durch N bei digitaler Rechnung nur eine Rechtsver¬ 
schiebung, und der dargestellte Algorithmus wird sehr schnell arbeiten. 

Bei Betrachtung der Gl. (4.113) fällt auf, daß mit fortschreitendem n der Einfluß von 
x{m) linear ab-, der von x{m + 1) linear zunimmt. Man kann sich die Entstehung des 
Geradenzugs im Bild 4.56 a auch so vorstellen, daß die Folge der (dick hervorgehobenen) 
x{m) mit der im Bild 4.56b gezeichneten Gewichtsfolge gefaltet wird. Diese Gewichts¬ 
folge, die für die lineare Interpolation die Form 

11 _ JilL für I«| < V 

g(n)=l ^ (4.114) 

lo sonst 


hat, kann als kennzeichnend für alle Interpolationsverfahren, die die Eigenschaft der 
Linearität besitzen, angesehen werden. Damit sind die Verfahren der Theorie zeit¬ 
diskreter Systeme zum Entwurf und zur Analyse von linearen Interpolationsalgorithmen 
anwendbar. Unter diesem Aspekt fällt auf, daß die Gewichtsfolge im Bild 4.56 b für 
negative Werte von Null verschieden ist und somit ein akausales System beschreibt. Das 
stellt hier keine Einschränkung an die Realisierbarkeit dar, da der gesamte Prozeßverlauf 
gespeichert ist und somit auch auf die (von einem bestimmten m aus gesehene) Zukunft 



Bild 4.57. Gewichtsfunktionen von Interpolationsverfahren 

a) Interpolation über ein Intervall mit stetigen Übergängen; b) quadratische Interpolation in disjunkten Intervallen; 
c) quadratische Interpolation mit überlappenden Intervallen; d) Interpolation durch ideale Bandbegrenzung 


zugegriffen werden kann. Bild 4.57 zeigt die Gewichtsfunktionen einiger Interpolations¬ 
verfahren. Die Knickstellen des Polygonzugs im Bild 4.56 a bedeuten Inder Achsbewegung 
Sprünge der Geschwindigkeit. Soll das vermieden werden, kann ein Algorithmus mit 
einer Gewichtsfunktion nach Bild 4.57a verwendet werden. Er garantiert stetige Über¬ 
gänge zwischen den Intervallen und stetigen Anschluß der Geschwindigkeiten. Rechen¬ 
technisch bietet die Interpolation durch Polynome besondere Vorteile. Dazu zeigen die 
Bilder 4.57b und 4.57c Gewichtsfunktionen von Algorithmen zur quadratischen Inter¬ 
polation. Im ersten Fall (Bild 4.57b) wird durch je drei aufeinanderfolgende Stützwerte 
eine Parabel gelegt und verfahren, während im zweiten Fall (Bild 4.57c) die durch drei 
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aufeinanderfolgende Stützwerte gelegte Parabel jeweils nur im ersten Intervall verfahren 
wird. Damit wird die Größe des Geschwindigkeitssprungs von Bild 4.57b reduziert. Eine 
in gewisser Hinsicht optimale Interpolation wird bei Verwendung der Spaltfunktion 


gin) 


n 

sin 71 — 
N 



(4.115) 


als Interpolatorgewichtsfolge erhalten. Sie entspricht einer idealen Frequenzband¬ 
begrenzung des Eingangssignals. Bild 4.58 zeigt dazu den entstehenden Interpolations¬ 
fehler (mittlerer Fehlerbetrag) bei Anwendung dieser Interpolation auf die beim Farb¬ 
spritzen beobachteten Prozesse. 



Bild 4.58. Mittlerer Fehlerbetrag bei Interpolation 
mit idealer Bandbegrenzung 

(7) für die Grundachse nach Bild 4.54; 

(2) für die Handachse nach Bild 4.54 


Bild 4.59. Mittlerer Fehlerbetrag bei verschiedenen 
Interpolationsverfahren in Abhängigkeit von der 
Abtastfrequenz beim Teach-in 


Bild 4.59 gibt die Abhängigkeit des mittleren Fehlerbetrags von der Abtastfrequenz bei 
verschiedenen Interpolationsverfahren für den Bewegungsvorgang einer schnellen Hand¬ 
achse ((^ nach Bild 4.54 und Bild 4.58) an. Die Fehlerkurven für die im Bild 4.57 an¬ 
gegebenen Verfahren liegen im schraffierten Bereich. 

Im Gegensatz zum bisher behandelten Verfahren, das die erforderliche Abtastfrequenz 
an den Prozeßeigenschaften als Ganzes bemißt, nimmt das Verfahren der adaptiven 
Steuerung der Abtastfrequenz auf die lokale Prozeßdynamik Bezug. Bild 4.60a zeigt das 
Wirkungsschema. In Abhängigkeit vom Prozeßverlauf wird dabei durch die Frequenz¬ 
steuerung ein Taktgenerator so gesteuert, daß bei hoher Prozeßdynamik (ein Maß "dafür 
kann die aktuelle Geschwindigkeit sein [4.25]) eine hohe, bei langsamer Änderung der 
Positionswerte mit der Zeit eine niedrige Abtastfrequenz eingestellt wird. Zur einwand¬ 
freien Reproduktion der Positionswert-Zeit-Folge muß eine Information über die aktuelle 
Abtastfrequenz in den Arbeitsspeicher mit eingetragen werden. Diese steuert bei Wieder¬ 
gabe den Taktgenerator, der physikalisch die gleiche Baugruppe wie bei der Aufnahme 
sein kann. Bild 4.60 b zeigt ein Beispiel der adaptiven Taktung. Von den Verfahren zur 
Verminderung der Speicherwertbreite lassen sich viele in die Klasse der Vorhersage- 
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verfahren einordnen. Bild 4,61a zeigt das Wirkungsschema, Durch ein Vorhersagefilter 
wird aus der Vergangenheit des Positions-Zeit-Verlaufs a: ein Schätzwert x* für den 
nächsten zu erwartenden Wert ermittelt und der Schätzfehler aufgezeichnet. Bei der 
Wiedergabe wird der eingegebene x-Wert-Verlauf durch ein entsprechendes inverses 
System (im Bild 4,61 a rechts dargestellt), das das gleiche Vorhersagefilter im Rückwärts¬ 
zweig eines digitalen Integrators enthält, wieder rekonstruiert. Für das Vorhersagefilter 
können Algorithmen der polynomialen Vorhersage verwendet werden. Sie lauten für eine 
Vorhersage 

0. Ordnung: x*(«) = a:(« — 1) 

1, Ordnung: x*{n) = 2x{n — 1) —x{n — 2) (4,116) 

2, Ordnung: x*{n) = 3x(n — 1) —3x(ii — 2) + x (n — 3), 


X 




Bild 4.60 

Bahnkurvenaufzeichnung mit 
adaptiver Steuerung der 
Taktfre(juenz 

a) SignalfluDschema; b) Wirkungsweise 



Bild 4.61. Bahnkurvenaufzeichnung mit Vorhersagefilter 

a) Wirkungsschema; b) Vorhersage 0. und 1, Ordnung 



Im ersten Fall wird angenommen, daß der Positionswert konstant bleibt und folglich 
die Differenz jeweils zweier aufeinanderfolgender Positionswerte aufgezeichnet wird. Bei 
der Vorhersage 1, Ordnung wird angenommen, daß der aus den beiden vergangenen Ar- 
Werten ermittelte lineare Trend anhält, und bei der Vorhersage 2, Ordnung wird der 
Schätzwert x*{n) als Wert einer Parabel, die durch die Werte x (n — 1), x (n — 2) und 
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x(n — 3) geht, berechnet. Das entspricht der Annahme einer gleichbleibenden Beschleu¬ 
nigung. Bild 4.61 b zeigt die Ermittlung des Schätzwerts x*(n) für eine Vorhersage 0. 
und 1. Ordnung. Anstelle der soeben dargestellten polynomialen Vorhersage kann auch 
eine optimale Vorhersage nach Wiener [4.29] vorgenommen werden, die auf der Aus¬ 
wertung des Leistungsdichtespektrums des Eingangsprozesses (Bild 4.54) basiert. 


Teach-in 



a) Wirkungsschema; b) Zeitverläufe und abgespeicherte Bitfolge 


Den Extremfall der Spei eher wort Verkürzung stellt das Datenkompressionsverfahren 
nach der Deltamodulation dar, das auch in der Übertragungstechnik häufig angewendet 
wird. Hier wird je Positionswert ein einziges Bit aufgezeichnet: allerdings muß die Ab¬ 
tastfrequenz viel höher liegen als bei den bisher behandelten Verfahren. Bild 4.62a zeigt 
das Wirkungsschema. Der aktuelle Positionswert x wird im Rhythmus des Aufnahme¬ 
takts mit einem Vergleichswert x verglichen, der in einem digitalen Integrator nach der 
Vorschrift 


+ A 

für 

£ ^ 0 

<1 

1 

für 

£ < 0 


(4.117) 


gebildet wird, wobei 

E(n) = x(n) — x(n) 


(4.118) 


ist. Aufgezeichnet wird dabei 


eine 1, wenn e ^ 0, und 
eine 0, wenn e < 0 ist. 

Bild 4.62 b zeigt dazu einen Zeitverlauf x{t), seine Approximation durch x(t) und unten 
die aufgezeichnete Bitfolge. Für eine Achse wird damit eine Speicherbreite von 1 bit be¬ 
nötigt, und man kann acht Achsen in einem 1 byte breiten Speicher unterbringen. Dieses 
System ist aus der Regelungstechnik als Zweipunktregler bekannt. Die Reproduktion der 
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ursprünglichen Positionswert-Zeit-Folge geschieht wieder durch das inverse System, das 
in einem digitalen Integrator, von den abgespeicherten e-Werten gesteuert, die entspre¬ 
chenden Schrittwerte + A oder —A aufintegriert. Eine wesentliche Verbesserung des Ver¬ 
fahrenskann durch eine sich der Änderungstendenz des Verlaufs von a: anpassende Schritt¬ 
weitensteuerung von A erzielt werden. Sie ist im Bild 4.62a eingezeichnet. 


4.6.2. Koordinatentransforination 

Koordinatentransformationen für Industrieroboter stellen den funktionellen Zusammen¬ 
hang zwischen natürlichen Koordinatenangaben und den Stellungen der Bewegungs¬ 
achsen her. Position und Orientierung des Endelfektors sind i.allg. von der Stellung 
jedes einzelnen Manipulatorglieds abhängig. Bei n Gliedern muß jeder Raumpunkt durch 
n Positionswerte beschrieben werden; diese spannen ein n-dimensionales gerätespezi¬ 
fisches Koordinatensystem auf. 

Bezüglich der Steuerung müssen Koordinatentransformationen zwei Aufgaben erfüllen: 

- Bestimmung der Lage des Werkzeugs oder Greifers in kartesischen Koordinaten aus 
gegebenen Positionswerten der Dreh- und Schubgelenke, 

- Berechnung der geräteeigenen Koordinaten aus den in kartesischen Koordinaten vor¬ 
liegenden Steuerinformationen. 


fl 


0 




Arbeits¬ 

speicher 


I 


PI 


Kreis 


PZ 


P3 


Gerade 


PU 


Bahn- 

interpolator 


Bahninter¬ 
polator für 
Kreisbogen 


Bahninter¬ 
polator für 
Gerade 


Handbediengerät 


IKT 


DKT 




Lage¬ 

regelkreise 


Manipulator 

—n 


1 




<li 



1 Teach-in 

2 Arbeitsphase 



Bild 4.63 

Prinzip der Bahnkurvenabspei¬ 
cherung und -erzeugung bei der 
Interpolationssteuerung (a) und 
Wirkungsweise der Funktions¬ 
interpolatoren (b) 


Die erste Aufgabe ist von Bedeutung, wenn die zur Interpolation in kartesischen Ko¬ 
ordinaten notwendigen Stützpunkte mittels Teach-in-Verfahrens gewonnen werden; sie 
soll als direkte Koordinatentransformation (DKT) bezeichnet werden. Die zweite Auf¬ 
gabe ist nicht nur für die Umsetzung der Interpolationswerte bei Bahnsteuerungen not¬ 
wendig; sie bildet auch eine Voraussetzung für die Eingabe von Steuerinformationen in 
natürlichen Koordinaten und die Nutzung von Sensorinformationen. Sie wird entspre¬ 
chend der Aufgabenstellung des inversen kinematischen Problems [4.5] als inverse Ko- 
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ordinatentransformation (IKT) bezeichnet. Die Aufgaben der Koordinatentransforma¬ 
tionen bei der Interpolationssteuerung verdeutlicht Bild 4.63. Die vom Effektor zu be¬ 
schreibende Bahnkurve wird vom Bediener in Geradenstücke und Kreisbögen zerlegt, 
deren charakteristische Daten im indirekten Teach-in eingelesen werden. 

Offensichtlich bestehen Echtzeitforderungen nur bezüglich der IKT. Da Koordinaten¬ 
transformationen über diese beiden Aufgaben hinaus in vielfältiger Form zur Umrechnung 
zwischen verschiedenen ruhenden und bewegten Bezugssystemen und zur Aufgaben¬ 
beschreibung bei der textuellen Programmierung benötigt werden, sollen sie nachfolgend 
etwas ausführlicher dargestellt werden. 


4.6.3. Homogene Transformationen 


Einen allgemeinen Ansatz zum Aufstellen von Lösungsgleichungen für die Koordinaten¬ 
transformation bietet die Transformation von Koordinatensystemen. Zwei ortho- 
normierte Koordinatensysteme sind durch Translation und Rotation ineinander über- 
führbar; es gelten folgende Zusammenhänge: 

Die Koordinaten des Punktes P (x', y', z') (Bild 4.64a) sind im Koordinatensystem, 
das aus dem gestrichenen durch Drehung um den Winkel O bei fester z-Achse entsteht, 


oder 


X = x' cos 0 y' sin 0 
y = —x' sin 0 y' cos 0 
z = z' 



cos 0 
— sin 0 
0 


sin 0 
cos 0 
0 


0 


0 

1 





(4.119) 


(4.120) 


Entsprechend gilt für die Drehung um die j'-Achse 



(4.121) 


Bild 4.64. Drehung eines Koordinatensystems (a) und Darstellung eines ruhenden Koordinatensystems (b) 
in einem anderen, ebenfalls ruhenden System 
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und Rotation um die x'-Achse 
/ x\ /I 0 


I j I = I 0 cos siny) I j y I = R^r'. (4,122) 

\z/ \0 —siny) cos ip/ \z'/ 

Durch Multiplikation der Matrizen erhält man bei Beachtung der Reihenfolge die Ge¬ 


samtrotationsmatrix 


iL jL K 


R<t>0\ii — R^ReRui — I iy jy ky 1. (4.123) 

\/^ n kJ 

Die Elemente der Rotationsmatrix sind die Richtungskosinus der gestrichenen Vektor¬ 
basis im ungestrichenen System: 

i'j, = cos 0 cos 0 

jx = cos 0 sin 0 sin y — sin 0 cos ip 
k'x = sin 0 sinip — cos 0 sin 0 cos ip 


= —cos 0 sin 0 


j'y = COS 0 cos ip — sin 0 sin 0 sin ip (4,124) 

ky = cos 0 sinip -I- sin 0 sin 0 cos ip 
ig = sin 0 
jg = — sin cos 0 
k' = cos 0 cos ip. 

Anschaulich bedeuten sie die Projektionen der Einheitsvektoren k' auf die ent¬ 
sprechenden Koordinatenachsen des ungestrichenen Systems. Entsprechend Bild 4.64b 
läßt sich damit der Punkt R{x', y', z'), dessen Koordinaten im gestrichenen System vor¬ 
liegen, im ungestrichenen angeben zu 


(4.125) 


y = \ y' I =p + ^00^- 


Gl, 4,125 läßt sich in folgender Form zusammenfassen: 


Jx kx Px 

./ ./ 

Jy ^y Py 
Jz kx Pz 
0 0 0 1 


= Tr'. 


(4.126) 


Diese Darstellung hat in der projektiven Geometrie Bedeutung. Durch die Beschreibung 
eines Punktes mit vier Koordinaten 
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wird in der obigen Transformation eine Gesamtskalierung möglich; zur maßstabgerech¬ 
ten Umrechnung ist /: = 1 zu setzen. Die Werte x, y, z, k werden als homogene Koordi¬ 
naten bezeichnet, T als homogene Transformation. Häufig werden anstelle der Dreh¬ 
winkel um die Achsen des Koordinatensystems auch die Eulerschen Winkel benutzt; die 
Richtungskosinus werden damit 


ix = cos cos 0e COS — siu 0^ sin (4.127) 

= — cos 0^ cos sin — sin 0^, cos y)^ 
kx = cos 0^ sin 


iy = sin cos 0^. cos + cos 0^ sin yj^ 
jy = — sin 0^ cos sin ip^ + cos 0^ cos ip^ 
ky = sin 0^ sin 0^ 
iz = — sin 0 e cos ip^ 

= sin sin y)^ 
k '2 = cos 0 e. 



Bild 4.65 

Darstellung eines Koordinatensystems, das 
in zylindrischen (a) und in sphärischen Ko¬ 
ordinaten (b) bezüglich des Basissystems 
verschoben ist 


Entsteht die Vektorbasis des gestrichenen Systems durch Verschiebung und Drehung in 
zylindrischen Koordinaten aus dem ursprünglichen, gilt die Transformation (Bild 4.65) 

^cos 99 —sin 99 0 r cos 99 > 

sin 99 cos 99 0 r sin 99 

0 0 1z 

0 0 0 1 

und für Verschiebung in Kugelkoordinaten r, cpi, ypzif = l/^l) 


J. = 


T,= 


cos (fl cos 992 

— sm 99 i 

cos (pi sin 992 

r cos 99 1 sin 

sin 991 cos <p 2 

cos (pi 

sin 991 sin 992 

r sin 99 i sin 

— sin 992 

0 

cos (p 2 

r cos 992 

0 

0 

0 

1 


(4.128) 


(4.129) 


4.6.4. Direkte Koordinatentransformation 

Die Angabe von Position und Orientierung des Endeffektors hängt wesentlich vom 
vorgesehenen Einsatzfall ab. Eine zweckmäßige Wahl des Positionspunktes P (x, y, z) 
für einen Greifer wird im Bild 4.66 a gezeigt. Legt man in diesen Bezugspunkt ein greifer- 
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festes Koordinatensystem, läßt sich die Orientierung durch geeignete Wahl eines zweiten 
Punktes in diesem Koordinatensystem angeben. Beide Punkte beschreiben eine Gerade 
im Raum, deren Richtung im raumfesten Basissystem jc, y, z die Orientierung festlegt. 
Ein solcher Punkt im Greiferkoordinatensystem ist auch der Punkt R' (1, 1, 1), der durch 
die Einheitsvektoren /g, 7 g, kg definiert ist [4.5]. Position und Orientierung sind damit 
durch die homogene Transformationsmatrix 

Jgx kgjc Px 

^ey Jey ^sy Py 

^"g2 jgz kg2 P 2 
0 0 0 1 




angebbar. Wegen 4 = sind die ersten drei Spalten nicht voneinander unabhängig. 




Bild 4.66. Effektorkoordinatensystem für Greifer (a) und Bild 4.67. Zur Ableitung der 

Sch weißkopf (b) Denavit-Hartenberg-Matrix 


Die Orientierung ist durch Angabe von drei Elementen der Rotationsmatrix eindeutig 
bestimmt, wird jedoch eines dieser Elemente bei bestimmten Greiferstellungen Null, 
treten Mehrdeutigkeiten auf. Mit den Beziehungen (4.124) lassen sich die Orientierungs¬ 
winkel aus Jg ableiten: 


0 = arctan- 


ip = arctan — 


./gr 


0 = arcsin . 


(4.131) 


Für einen rotationssymmetrischen Schweißkopf gemäß Bild 4.66b läßt sich die Orien¬ 
tierung aus der Transformation 



) 


(4.132) 


bestimmen. Der Vergleich mit Gl. (4.124) zeigt, daß hierbei der Winkel 0 unbestimmt 
bleibt, da R auf der z'-Achse liegt. Wir setzen 0 = 0 und erhalten als Orientierungs¬ 
winkel 


ip = arcsin k^y , 


0 = arctan — 

kgz 


(4.133) 
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Für die Effektorstellung ergeben sich damit in Komponenten des Basissystems x, y, z 

f‘x = 'ex + Jex + ^ex + Px 

fy igy + Jgy + kgy + Py (4.134) 

fz ^"gz “I“ y'gz "I“ ^gz "I” Pz • 

Diese Darstellung läßt sich vorteilhaft bei der indirekten Teach-in-Programmierung zum 
Verfahren der Roboterachsen in natürlichen Koordinaten anwenden. Ordnet man das 
Handbediengerät im Bild 4.63 vor der IKT an, sind folgende Handbedienfunktionen 
realisierbar: 


- Verfahren in den Richtungen x,y,z bei raumfester Orientierung; Eingabedaten p^, 

Py J Pz 5 

- Änderung der Orientierung im greifereigenen Koordinatensystem bei fester Position 
durch Rotation um die Achsen x^, y^, z^; die Eingabedaten berechnen sich aus 



^ ^'gz 7'gz 



Ar;, = A/g;, + Ay'g;, -h 
Ar^ = A/gy -|- A^gj, -|- AÄ^gj, 

Ar^ = A/g^ + A/g, -I- AÄTg,, 


(4.135) 


- Änderung der Orientierung bei fester Position durch Rotation um die Achsen des 
Basissystems; die Eingabedaten berechnen sich aus 


/ 1 0 0 \ Ar^ = A/g;, 

- I 0 1 0 j = Ar, Ar^ = Aj\y (4.136) 

\0 0 1/ Ar, = AÄ:g,. 

(bzw. Re, R^) 

Um die Elemente der Matrix Jg aus der momentanen Stellung der n Gelenke zu be¬ 
stimmen, ordnen wir jedem Gelenk ein gliedfestes Koordinatensystem zu, so daß das 
«-te Koordinatensystem mit dem werkzeugeigenen Koordinatensystem übereinstimmt 
(Bild 4.66). Unter der Voraussetzung, daß die Achse z^-i in der Bewegungsachse des 
folgenden Gliedes liegt und Xi ± z,_i und von der Achse i — 1 fortzeigend, läßt sich 
das i-te Koordinatensystem im Koordinatensystem i — 1 durch die Denavit-Hartenberg- 
Matrix [4.30] beschreiben (Bild 4.67): 


A, = 


fcos (fl —cos sin epi sin ^x^ sin cpi cos 99 ,- 
sin 99 ,. cos (Xj cos 99 ,- — sin (x,-cos 99 ^ /,i sin 99 ,- 

0 sin oc^ cos (X^ l ^2 

0 0 0 1 


(4.137) 


Sie stellt eine reduzierte Form der homogenen Transformation dar, da unter den obigen 
Bedingungen die Koordinatensysteme durch zwei Translationen /,i, 7^2 und zwei Rota¬ 
tionen 99 , X ineinander übergeführt werden. Industrierobotergelenke werden in der Regel 
so konstruiert, daß die = 0° bzw. 90° sind und eine der Translationen Null ist, was zu 
weiteren Vereinfachungen führt. Bei Schubgelenken ist eines der /,. variabel, bei Dreh¬ 
gelenken 99j. Liegt im weiteren nur eine Translation vor, wird sie mit /; bezeichnet. 

Die Greiferstellung Tg erhält man nun in Basiskoordinaten durch Multiplikation aller 
^-Matrizen 


Tg = A 1 A 2 ... A„. 


(4.138) 
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A, = 


Für die Konfiguration im Bild 4.68 ergeben sich die .^-Matrizen zu 
'COS (fl 0 sin (pi 0 

0 —cos (pi 0 

1 0 u 

0 0 1 

— sin9?2 0 4 cos 9)2' 

cos (p2 0 I2 sin q)2 

0 1 0 

0 0 1 


A, = 



A, = 


/COS 993 

-sin 993 

0 

/3 cos 993 \ 

/ sin 993 

COS 993 

0 

/3 sin 993 1 


0 

1 


\ 0 

0 

0 

1 / 


A^ = 


A, = 


A^ = 


/cos 994 

0 

sin 994 

“\ 

/ sin 994 

0 

— cos 994 

A 


1 

0 

0 / 

\ 0 

0 

0 

1 / 


^costps 0 —sin 995 0 
sin (p5 0 cos 9?5 0 

0-1 0 Is 

0 0 0 1 


/cos (pe 

-sin 9^6 

0 

"\ 

j sin 996 

cos <Pß 

0 

” 1 


0 

1 


\ 0 

0 

0 

1 / 














( 4 . 139 ) 


Bild 4.68. 6-Achsen-Gelenkroboter und dessen kinematisches Schema mit gelenkeigenen Koordinaten¬ 
systemen 
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Durch Ausmultiplizieren von rechts nach links erhalten wir die Bestimmungsgleichungen 
für die Elemente der Matrix T^ : 

hx — cos 9?i cos {(p2 + 953 + 994) cos 9?5 cos 9?6 — sin 991 sin 995 cos cp^ 

— sin (992 + 993 + 994.) cos 99i sin 99^ 

igy = sin 991 cos (993 + 993 + ^4) cos 995 cos 995 + cos 99^ sin 995 cos 99^ 

— sin (992 + 993 + 994) sin 991 sin 995 

/gz = sin (992 + 993 + 994) cos 995 cos 995 + cos (993 + 993 + 994) sin 99^ 
y’gjc = —cos 99i cos (992 + 993 + 994) cos 995 sin 995 — sin 99^ sin 995 sin 99^ 

— cos 991 sin (992 + 993 + 994) cos 99^ 

/gy = —sin 991 cos (993 + 993 + 994) cos 995 sin + cos 991 sin 995 sin 99^ 

— sin 99i sin (993 + 993 + 994) cos 99^ 

7gz = cos (993 + 903 + 954) cos 995 - sin (993 + 993 + 9C4) cos 995 sin 995 

kgjc = sin q)i cos 995 — cos 99^ cos (993 + 993 + 994) sin 995 ( 4 , 140 ) 

kgy = —sin (pi cos (993 + 993 + 994) sin 995 — cos 99^ cos 995 
= -sin (993 + 993 + 994) sin 995 

Px — h cos 991 cos 993 + cos 991 cos (993 + 993) + sin (993 + 993 + 994) 

cos (pi + /ß [sin 99i cos 995 — cos 991 cos (993 + 993 + 994) sin 995] 

Py = I2 sin 99i cos 993 + /3 sin 991 cos (993 + 993) + /j sin 99^ sin (993 + 993 + 994) 

— /ß [sin 99i cos (993 + 993 + 994) sin 995 + cos 991 cos 995] 

Pz = h + h sin 993 + h sin (993 + 993) - cos (993 + 993 + 994) 

— le [sin (993 + 993 + 994) sin 995]. 

Bei der Festlegung der Nullstellung für die Gelenkwinkel ist zu beachten, daß keine 
Mehrdeutigkeiten auftreten. Die jg-Komponenten lassen sich auch aus dem Vektor¬ 
produkt der zweiten und dritten Spalte der Matrix Tg ermitteln, so daß die Bestimmung 
von sechs Rotationselementen ausreicht. Die Orientierungswinkel lassen sich mit Hilfe 
der Beziehungen ( 4 . 131 ) berechnen. 

Verhältnismäßig einfache Beziehungen für die DKT ergeben sich, wenn sich die 
Orientierung des Endeffektors relativ zur Position der Grundachsen durchführen läßt 
oder einschränkende Bedingungen für die Orientierung vorliegen, z. B. senkrechte Greifer- 
stellung. Unter bestimmten Voraussetzungen für die Anordnung der Handachsen läßt 
sich die Koordinatentransformation generell auf eine getrennte Betrachtung der Hand- 
und der Grundachsen zurückführen, was beträchtliche Vereinfachungen mit sich bringt 
[ 4 . 31 ]. 
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Für zylindrische Grundachsen DLL (Bild 3.2) berechnet sich die Position des End¬ 
punktes der dritten Achse aus 

Px = h cos cpi 

Py = l2?4n(pi (4.141) 

Pz = h 

für Kugelkoordinaten aus Gl. (4.129) 

Px = h cos cpi sin (p 2 

Py = li sin 991 sin (p 2 (4.142) 

p^ = li cos (p 2 

und für die Struktur DDD (Bild 4.69 c) 

Px = h cos cpi cos (p 2 -f- h cos (992 + 993 ) cos 

Py = h cos cp 2 sin 99 i -f- cos (992 + 993 ) sin 99 ^ (4.143) 

Pz = h + h sin cp 2 - h sin (992 + 993 ). 

Die Realisierung der DKT ist nicht an Echtzeitforderungen gebunden, da sie nur in der 
Teach-in-Phase benötigt wird. Die trigonometrischen Funktionen werden entweder durch 
Tabellenzugriff oder mittels Standardroutinen bestimmt. 


4.6.5. Inverse Koordinatentransformation 


Die IKT berechnet aus gegebenen kartesischen Koordinaten Px, Py, Pz und Vx, Vy^r^dit 
zugehörigen Gelenkstellungen 

qi = fiip, f) 

: (4.144) 

qn 

Industrieroboter sind in der Regel so konstruiert, daß dieses Gleichungssystem für n^6 
im klassischen Sinne lösbar ist. Ist dies nicht der Fall, nennt man die Konstruktion 
redundant. Zur Lösung der inversen Koordinatentransformation für redundante Kon¬ 
figurationen sind zusätzliche Bestimmungsgleichungen erforderlich, die aus der durch¬ 
zuführenden Bewegung gewonnen werden. Für den redundanten Fall, daß drei Dreh¬ 
gelenke (pi, (pi, 993 in einer Ebene liegen, läßt sich durch die Annahme, daß 99 ^=^ 
X ( 99 ^ -f- 992 ), eine einfache Zusatzbedingung schaffen, die die Lösbarkeit garantiert. 

Die Lösungsgleichungen lassen sich sukzessive aus Gl. (4.138) durch Multiplikation 
mit inversen y4-Matrizen in folgender Reihenfolge aufstellen: 

A2A3 ... A„ = Al Tg 

A3A^...A„ = A2"A:^T^ (4.145) 


^n- 1 • • • 1 -* g • 

Da jede der yl-Matrizen nur eine Variable enthält, ergeben sich aus den rechten Seiten 
nacheinander n Lösungsgleichungen durch Elementevergleich der rechten und linken 
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Seiten und Eliminieren der noch unbekannten Gelenkkoordinaten. Die Determinanten 
der yl-Matrizen sind dabei stets eins. Für die Konfiguration Bild 4.69 ergeben sich mit 
den .(4-Matrizen aus Gl. (4.139) folgende Lösungen für die Gelenkkoordinaten: 


[ Py \ 

= arctan 

\PxJ 


P' = (Px, Py, p'z) = P 




iC 

{cp2 + 9^3 + 954) = arctan- - - 

cos + sin 9?ikg 

sin 9?3 


9?3 = arctan 


cos 933 

[cos (pip^ + sin (pxp'y - sin (932 + (ps + ff*) hV 
+ [p'z + cos (932 + 9>3 + 934) IsY - I2 - ll 


cos 933 = 

= ±V 1 — cos^ 933 


2/2/3 


sin 933 


(/3 cos 933 + I2) [p'z + cos (932 + 933 + 9^4) /s] 
— li sin 933 [cos q)iPx + sin cpip'y — Is sin {(p2 


(4.146) 


(/3 COS 933 + I2) [cos (pip'x + sin Cpiyy — 

+ I2 sin 933 [p' + cos {(p2 + 9^3 + 954) /s] 


+ 9^3 + 934)] 


933 = arctan- ^^^^ -=—-^— 

oyp'y - sin (932 + 933 + 9^4) /s] 

I \ f 1 


934 = (932 + 933 + 934) - 933 - 932 


935 = arctan 


— cos (932 + 933 + 934) (cos (p^k^x + sin 93iÄ:gj,) 

- sin (932 + 933 + 934) _ 

sin (pik^x — cos cp^k^x 


-cos 935 [cos (932 + 9?3 + 9?4) (cos rpj^x + sin cpj^y) 

+ sin (932 + 933 + 934)ygz] - sin 935 (sin rpj^x - cos tpj^y) 
cos (932 + 933 + (p^j^z - sin (9>2 + 9^3 + ^*){jex cos 93 ^ 
+ yg„ sin 931) 




Bild 4.69. Zylindrische (a), sphärische (b) und Dreigelenk-Grundachsen (c) 

Der Positionspunkt ist hierbei auf das Ende der letzten Grundachse bezogen. 


Liegen weniger als sechs Gelenke vor, ist das Koordinatensystem des jeweils letzten Ge¬ 
lenkes in den Effektor zu legen; die Achsbezeichnungen dieses Koordinatensystems sind 
entsprechend den Forderungen an die J-Matrizen zu wählen. Entfällt beispielsweise das 
sechste Drehgelenk, d.h. 935 = 0, gilt für das neue Effektorsystem der fünften Achse 
kg = —jg5,jg = /g5,/g = —kgs, wobei ig5,jg5,kgs die Vektorbasis des Koordinaten- 
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Systems X 5 ,ys,Z 5 sind. Zur effektiven Berechnung sind aus Gl. (4.146) mehrfach be¬ 
nutzte Ausdrücke als Blöcke zusammenzufassen. 

Aus den möglichen Bestimmungsgleichungen ist die arctan-Darstellung vorzuziehen, 
da sie innerhalb der in Frage kommenden Wertebereiche auf einem Rechner eindeutig 
bestimmbar ist. 

Für die Grundachsen DDD gemäß Bild 4.69 c erhält man aus Gl. (4.143) die Gelenk¬ 
koordinaten 

9 ?! = arctan — 

Px 


fp 2 = arctan 



+ arcos 


Hl — 13 + Px + Py + Pz \ 
\ 2/2 ^Px + Py + Pz j 


(4.147) 


953 = arccos 



Die bisher dargestellten Verfahren berechnen die absoluten Werte der Gelenkkoordinaten 
aus den kartesischen Koordinaten. Für Bahnsteuerungen muß die IKT eine Punktfolge 
j (Ati), s = (r^,ry, r^,Px,Py,Pzy in die Sollwertfolge q (At^), q = q„y umrech¬ 

nen. Sind die ausreichend klein, gilt für zwei aufeinanderfolgende Bahnpunkte 
~ ^t +15 da aufgrund der begrenzten Beschleunigung keine Sprünge in der Bewegungs¬ 
bahn auftreten können. Wird nur die Abweichung A^^ = in die entsprechende 

Abweichung der Sollwertfolge q^ umgerechnet, entsteht ein inkrementeiles Verfahren. 
Für den Bahnvektor in kartesischen Koordinaten gilt 


5(0 = 5 [qyt ),..., ^„( 0 ]. 


Unter der Voraussetzung, daß 5(0 und ^^(0 stetig und differenzierbar sind - diese An¬ 
nahme ist berechtigt, weil die Roboterachsen trägheitsbehaftet sind und keine Bahn¬ 
sprünge zulassen - ergibt die zeitliche Ableitung 


ds _ y ds Sqi _ j dqi 
dt i= 1 dqi dt dt 


ds = Jdq 


(4.148) 


mit J als Jacobi-Matrix. Ist diese invertierbar, kann durch Linearisierung 


Aq X J ^ As 

eine Vorschrift zur Berechnung der Achsinkremente gewonnen werden, wenn A 5 aus¬ 
reichend klein gewählt wird. 

Für die DDD-Struktur ergeben sich aus Gl. (4.147) die Inkremente 


> 

II 

^2 ^ ^2 

H 

<1 




> 

II 

cos ( 9?2 + 993 ) 
h sin 9)3 

- Ar -1- 

sin (92 -1- 93) 
I 2 sin 93 

N 

<1 

(4.149) 

A(p3 = 

r 

• Ar -f- 

Pz 

^Pz\ 

r = ypl + pI . 

I 2 + h sin 93 

I 2 + -h sin 93 
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Die benötigten Absolutwerte der Winkel (pi, <p 2 , 9^3 werden durch Integration bestimmt 
(Bild 4.70). Die Lösungsgleichungen sind für diese Achskonfiguration besonders einfach 
und führen zu relativ schnellen Algorithmen [4.32], Nachteil dieses Verfahrens ist, daß 
die aus der Linearisierung resultierenden Fehler sowie die durch die begrenzte Darstel¬ 
lungsgenauigkeit der Operanden im Rechner auftretenden Rundungsfehler sich bei der 
Integration fortpflanzen. 



Bild 4.70. Inkrementelle Koordinaten- Bild 4.71. Inkrementelle Koordinatentrans¬ 
transformation formation mit Rückführung 


Zur Kompensation der Fortpflanzungsfehler kann eine Rückführung der berechneten 
Achspositionen gemäß Bild 4.71 durchgeführt werden. Es entsteht ein Servosystem, das 
dem Newtonschen Algorithmus zur Lösung nichtlinearer Gleichungssysteme äquivalent 
ist. Das Inkrement As wird nicht aus aufeinanderfolgenden Positionswerten bestimmt, 
sondern aus der Differenz von Sollwert und tatsächlich berechneten Koordinaten, die 
hierzu wieder in kartesische Werte transformiert werden. Vorteilhaft ist dabei, daß die 
DKT nicht innerhalb ausgeführt werden muß, sondern nur nach einer bestimmten 
Anzahl von Iterationsschritten, die durch die Genauigkeitsforderung begrenzt wird, die 
Istposition zur Korrektur bereitstellt [4.33]. Durch zweckmäßige Wahl der Inkremen¬ 
tierung G (s, s') können die durch sprunghafte Eingangsfunktionen s — s' auftretenden 
Stabilitätsprobleme vermieden werden. 


4.6.6. Realisierung der Koordinatentransformation 

Genauigkeit und Taktzeit der inversen Koordinatentransformation sind aus der gefor¬ 
derten Positioniergenauigkeit und der Ersatzzeitkonstanten des kinematischen Systems 
zu bestimmen. Dies führt in der Regel zu der Forderung, einen vollständigen Koordina¬ 
tensatz mit etwa 16 bit Auflösung in 20 bis 200 ms bereitzustellen. Aus der Rechentechnik 
sind zur Realisierung dieser Echtzeitforderungen zwei unterschiedliche Methoden be¬ 
kannt. Die erste beruht auf der Off-line-Berechnung aller Funktionswerte und deren Ab¬ 
speicherung in einer Tabelle. Die Rechenzeit wird dann nur durch die Tabellenzugriffszeit 
bestimmt. Bei der zweiten Methode werden die Funktionswerte durch geeignete Approxi¬ 
mationsverfahren mit der gewünschten Genauigkeit berechnet. Ist der notwendige Werte¬ 
vorrat einer Tabelle sehr groß, wird häufig eine Kombination beider Methoden genutzt, 
d.h., es wird eine Tabelle von Stützwerten der gesuchten Funktion bzw. Teile derselben 
angelegt und zwischen den Stützwerten wird die Funktion durch Interpolation approxi¬ 
miert. Entscheidend für den einzugehenden Kompromiß zwischen Rechenzeit und Spei¬ 
cherplatz ist dabei die zur Verfügung stehende Hardware. Erfahrungsgemäß ist für den 
gleichen Algorithmus das Produkt von Rechenzeit und Speicherplatzbedarf auf einem 
Rechner annähernd konstant, d.h., je mehr Funktionswerte als Tabelle abgelegt werden, 
desto kürzer wird die Rechenzeit und umgekehrt. 

Zur Durchführung der Koordinatentransformation sind die Berechnungen der trans¬ 
zendenten Funktionen die aufwendigsten Operationen. 

Eine Wertetabelle für trigonometrische Funktionen kann sowohl mit konstanter Inter- 
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vallbreite (lineare Tabelle) oder als nichtlineare Tabelle mit konstantem Interpolations¬ 
fehler angelegt werden. Umfang und Genauigkeit der Tabelle sind so zu wählen, daß der 
durch Akkumulation aller Darstellungs- und Rundungsfehler in der vollständigen Be¬ 
stimmungsgleichung der Koordinate auftretende Gesamtfehler den vorgegebenen Wert 
nicht überschreitet. 

Für eine Kosinustabelle mit 500 Stützstellen und Qstelliger Darstellungsgenauigkeit 
(31 bit) ergibt sich bei linearer Interpolation zwischen den Stützstellen gemäß 


cos 9 ? = 


(y - y») (cos (P n + 1 - cos (p„) 
(pn + i - (Pn 


+ cos (p„ 


(4.150) 


im oberen Wertebereich (maximale Krümmung; s. Bild 4.72) ein maximaler Approxi¬ 
mationsfehler von e « 10“®. Diese Genauigkeit ist für die Rundung auf ein 16-bit-Wort 
ausreichend. Addition der Rundungsfehler ergibt für die berechneten Koordinatenwerte 
eine erreichbare Genauigkeit von etwa 10"^. 



Bild 4.7 2 

Approximationsfehler bei der linearen Interpolation zwischen 
Tabellenstützwerten einer Kosinustabelle 


Da die trigonometrischen Funktionswerte bis auf das Vorzeichen in allen Quadranten 
gleich sind, werden Tabellen nur für einen Quadranten angelegt. 

Grundsätzlich geeignet zur Approximation trigonometrischer Funktionen sind die 
Potenzreihe, die Kettenbruchapproximation, die rationale Approximation und die 
Tschebyschew-Reihe [4.34]. 

Die Potenzreihenentwicklungen, z. B. 

COS9? = X (4.151) 

n=o ( 2 „!) 

approximieren zwar mit der geringsten Genauigkeit - für N = 6 wird £ = 3-10“®-, 
sind aber einfach zu realisieren, da nur N Multiplikationen erforderlich sind. 

Eine weitere Klasse von Verfahren kombiniert das Tabellen verfahren mit der Funk¬ 
tionsapproximation. Die Funktion wird in einem Intervall (/<,/;+ 1 ) durch Polynome 
möglichst niedriger Ordnung interpoliert; die Intervallbreite ist durch den maximalen 
Approximationsfehler gegeben [4.35]. 

Da in der digitalen Rechentechnik die Realisierung von Multiplikationen und Divi¬ 
sionen am aufwendigsten ist, sind zahlreiche Verfahren entwickelt worden, die arith¬ 
metische Ausdrücke durch die rechentechnisch schnell realisierbaren Operationen 
Addition, Subtraktion und Verschiebung iterativ berechnen [4.36] [4.37] [4.38]. 

Ein für die Koordinatentransformation geeignetes Verfahren stellt der CORDIC- 
Algorithmus dar (coordinate rotation digital Computer). Mit ihm lassen sich die Funk¬ 
tionen 

- Multiplikation einer Zahl mit sin (p, cos tp 
Berechnung von Wurzeln 

- Berechnung von arctan 


10 Industrierobotersteue''ung 
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durch sukzessive Lösung von Differenzengleichungen bestimmen. Er ist besonders dann 
geeignet, wenn zur Berechnung dieser Funktionen keine schnelle Arithmetik zur Ver¬ 
fügung steht. 

Das Prinzip und die Anwendung zur Koordinatentransformation werden in [4.39] aus¬ 
führlich dargestellt. 

4.6.7. Trajektorienplaniing und Interpolation 

Die Art der Bewegungsbahn des Endeffektors hängt von der vom Manipulator durch¬ 
zuführenden Aufgabe ab. Für viele Anwendungen läßt sich die Steuerung des Effektors 
auf Geradenstücken vorteilhaft einsetzen, da die Anzahl der beim indirekten Teach-in 
anzufahrenden Punkte erheblich reduziert werden kann. Vom Bediener werden Anfangs¬ 
und Endpunkt der Geraden für die Position sowie die Geschwindigkeit v vorgegeben. Der 
Interpolator hat die Aufgabe, eine ausreichende Zahl von Zwischenpunkten zu erzeugen, 
die nach der IKT als Sollwertfolge an die Achsen ausgegeben werden. Sind Pa der An¬ 
fangs- und Pe der Endpunkt des Geradenstücks, ergeben sich für die Bahnlänge 

I = V(PxE - Px^y + (PyE - + (PzE “ Pzß.Y (4.152) 

und für die Interpolationsschrittweite 
M = vM. 

Die Interpolationstaktzeit Ar ist der Taktzeit der IKT gleichzusetzen. Ist diese größer als 
die kleinste Ersatzzeitkonstante der zu steuernden Antriebe, ist eine weitere Interpolation 
zwischen den berechneten Sollwerten der Achspositionen notwendig. 

Durch Integration der Differenzengleichungen für die Bahninkremente läßt sich 

A4 = (PxE- Pxa) -y 

A4 = (P,E - Pm) -y (4.153) 

^ A/ 

(.PzE Pzßu ^ 

die Differenz zwischen erreichtem und vorgegebenem Endpunkt zur Fehlerkompensation 
benutzen. Entsprechendes gilt für die Orientierung. 

Mit Hilfe von Geradenstücken können einfache Weg-Zeit-Verläufe approximiert wer¬ 
den (Bild 4.73a). Bei schnellen Bewegungen treten dabei an den Zwischenpunkten Stell¬ 
kraftsprünge der Antriebe auf, die zu Schwingungen des Roboterarms führen können. 
In der Regel ist das exakte Einhalten der Zwischenpunkte bei größeren Geschwindig¬ 
keiten aber nicht notwendig, so daß ein geeignetes Übergangsverhalten zwischen den 
Bahnsegmenten zulässig ist, das diese Schwingungen vermeidet. Eine konstante Be¬ 
schleunigung innerhalb der Übergangsphase des Weg-Zeit-Verlaufs führt zur quadrati¬ 
schen Interpolation. Gemäß Bild 4.73 b gilt 

Aüx = Px2 - Pxi = (4.154) 

d.h., die Geschwindigkeit wird linear geändert und verändert sich quadratisch. Diese 
Interpolation ist für alle Koordinaten von Position und Orientierung durchzuführen. 
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Zur Berechnung der Zwischenwerte werden damit neben Pq und Pj auch P 2 und die Ge¬ 
schwindigkeit des zweiten Bahnsegments benötigt. Der Übergang zur quadratischen 
Interpolation erfolgt zur Zeit t = ti — T. Die Bewegung des Effektors auf einer vorge¬ 
gebenen Kreisbahn wird als zirkulare Interpolation bezeichnet. 




Px 






f^-r fi+T t 

c) 



Bild 4.7 3 

(Jberschleifbewegung an den Zwischenpunkten; 
Position (a), Geschwindigkeit (b) und Beschleuni¬ 
gung (c) bei quadratischer Interpolation, dargestellt 
für eine kartesische Koordinate der Bahnkurve 


Ein einfaches Verfahren entsteht, wenn der Kreis durch Sehnen approximiert wird. Hier¬ 
zu ist aus den Kreisstützpunkten zunächst der Radius Rq zu bestimmen. Die Sehnenlänge 


A/ = IRq sin —; 

2 


y = 2 arcsin 



ist so zu wählen, daß die maximale Abweichung von der Kreisbahn eine vorgegebene 
obere Schranke nicht überschreitet. 

Neben der Programmierung der Orientierung über indirektes Teach-in wird häufig 
auch die Orientierung der Positionsänderung unmittelbar nachgeführt, wenn sie mit der 
Bahnkurve in einem funktioneilen Zuasmmenhang steht. Bei einer Kreisbewegung 
können beispielsweise die Winkel, die die Gerade durch P und R mit der durch den 
Kreis definierten Ebene bildet, eingegeben und bei der Bewegung nachgeführt werden. 

Bei Bahnsteuerungen sind Beschleunigungs- und Bremsphasen so zu gestalten, daß die 
technologischen Bedingungen des Prozesses eingehalten werden. Die Beschleunigüngs- 
vorgabe ist außerdem von den konstruktiven Merkmalen des Manipulators abhängig 

Zur Beschreibung komplizierter Raumkurven lassen sich Polynome höherer Ordnung 
einsetzen. Sind n Bahnpunkte r und die Geschwindigkeiten r(t,) gegeben, können die 
Bahnzwischenpunkte aus 

n- 1 

KO = Z (4.155) 

i = 0 

ermittelt werden. Die Koeffizienten 6,- und c, sind durch die Anfangs- und End¬ 
bedingungen sowie Randbedingungen, die sich durch zusätzliche Kriterien zum Zeit¬ 
verhalten oder zu den Bahnabweichungen ergeben, zu berechnen. 

Wegen des hohen Rechenaufwands sind solche Interpolationsverfahren für große n 
nur off-line durchführbar. 






148 


4. Bewegungssteuerung 


Reduziert man den Polynomgrad auf einige benachbarte Bahnpunkte, läßt sich die 
Interpolation sukzessive auf die gesamte Trajektorie anwenden. 

Zur Bewegungsplanung von Bahndaten, die über äußere Sensoren erfaßt werden, ist 
das Frame-Konzept geeignet [4.43]. Es beruht auf der Transformation von Koordinaten¬ 
systemen in Matrixschreibweise. 



Bild 4.74 

Koordinatensysteme zur Bewe¬ 
gungsplanung 


Wird ein Werkstück gemäß Bild 4.74 durch eine Frame (Koordinatensystem) be¬ 
schrieben, in dem die Greifposition festgelegt ist, gilt für seine Darstellung im Basis¬ 
system XQ,yo,ZQ: 

Tl = (4.156) 

homogene Transformation, die das Koordinatensystem Xs. Js. in Basiskoordinaten beschreibt 
beschreibt objekteigene Koordinatensystem in Stationskoordinaten Xj, yj, z^, 
kann z.B. durch die Erkennung von Lage und Orientierung eines Werkstücks mittels visueller Er¬ 
kennung bestimmt werden; 

■^s> >'s> können dabei i.allg. auch ein bewegtes Koordinatensystem darstellen (Transportband). 

Das Frame Tg beschreibt die Effektorstellung im Basissystem. Die Transformation T‘ 
beschreibt das werkstückeigene Koordinatensystem im greifereigenen Koordinaten¬ 
system. 

Mit Hilfe der Beziehungen 

Tg = T^Tin (4.157) 

lassen sich die Bahndaten berechnen, um aus der momentanen Greiferstellung eine in 
Tl vorgegebene Greifposition zu erreichen. Die Methode ist auch für die Arbeit mit be¬ 
wegten Objektkoordinaten geeignet; aus Gl. (4.157) ergeben sich in diesem Fall Daten 
für eine Folgebewegung. Die zeitlichen Änderungen der Koordinaten werden über ge¬ 
eignete äußere Sensoren (Geschwinidgkeit des Transportbands oder Bewegungsdaten 
des Objekts) erfaßt; damit wird Tl = r*(r,). 

Die Angabe von Position und Orientierung durch eine Frame wird in zahlreichen 
Programmiersprachen benutzt. Dabei ist zu unterscheiden, ob die Bewegungsdaten durch 
Angabe der Greiferstellung oder durch Angabe der Objektzustände programmiert wer¬ 
den (s. Abschn. 6.). Intern werden immer die notwendigen Positions- und Orientierungs¬ 
daten des Effektors durch Lösen der sich aus den Matrixmultiplikationen ergebenden 
Gleichungssysteme berechnet. Dabei sind die durch die Kinematik des konkreten 
Industrieroboters bedingten Beschränkungen für die Greiferstellung zu beachten. Durch 
günstige Wahl der Koordinatensysteme, insbesondere der Orientierungsangaben, läßt 
sich der Rechenaufwand reduzieren, d.h., die zu den Frames gehörigen Matrizen müssen 
möglichst viele Nullelemente enthalten. 
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Aktionssteuerung 


5.1. Grundfunktionen und Steuerungsentwurf 

5.1.1. Gnindfunktionen 

Die Aktionssteuerung hat die Aufgabe, die Aktionsbefehle des Roboterprogramms aus¬ 
zuführen, und stellt im Prinzip eine binäre Steuerung für die Roboterperipherie dar. Sind 
in der Peripherie zusätzlich analoge Steuerungsfunktionen (z.B. Schweißstromregelun¬ 
gen) zu realisieren, so ist dafür eine entsprechende Funktionsgruppe zwischen Bewegungs¬ 
steuerung und Aktionssteuerung einzuordnen. Im folgenden wird darauf nicht näher ein¬ 
gegangen. 

Die Aktionssteuerung entspricht im Prinzip der PC (programmable control) einer 
Werkzeugmaschinensteuerung. Im einfachsten Fall wird durch sie die kombinatorische 
Verknüpfung von binären Prozeßsignalen (z.B. Endlagenschalter-, Lichtschranken- und 
Initiatorsignale) gebildet und dadurch die Ansteuersignale für binäre Stellglieder (z.B. 
Schaltschütze, Magnetventile, Einfachantriebe) erzeugt. Im allgemeinen Fall realisiert 
die Aktionssteuerung mehrere voneinander unabhängige sequentielle Teilautomaten, 
Die Grundstruktur des Teilautomaten ist im Bild 5.1 dargestellt. Der Automat erhält 
über die Ausgangsgrößen x des Steuerungsobjekts die notwendigen Informationen, um 
dessen Zustand q zu ermitteln. Aus den Eingangsgrößen die sich aus dem entspre¬ 
chenden Aktionsbefehl herleiten, den Ausgangsgrößen x des Steuerungsobjekts und 
ihrem inneren Zustand z bildet die Steuerung entsprechend dem Steueralgorithmus die 
Stellgrößen y und den Folgezustand z. Zur Beschreibung des durch den Automaten zu 
realisierenden Ablaufs sind möglich 

- Automatengleichungen 

- Graphen und Netze 

- Sprachen. 


X 


«=d 

Steuerung 

-^ 

Sfeueningsohjeld 

_h 

fj=c^ 

-✓ 

y 



- ^ 


Zustand z 


Zustand q 





' Leiisfeuerung 
Bediener 



_N 

ROBOTER 

STEUERUNG 



& 

Transporteinheiten 

Speichereinheiten 

Bearbeifungseinheiten 


"- 


Bild 5.1. Grundstruktur eines Steuerungssystems 
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5 . Aktionssteuerung 


Für den Entwurf und zur Simulation des Zusammenwirkens von Steuerung und 
Steuerungsobjekt ist es sinnvoll, auch für das Steuerungsobjekt das gleiche Beschreibungs¬ 
mittel zu wählen. Werden dafür die Automatengleichungen benutzt, so sind die Zu¬ 
standsgleichungen für die Steuerung 


z' =f{z, X, xj, 

(5.1) 

das Steuerungsobjekt 


q' = (p {q, y) 

(5.2) 

und die entsprechenden Ausgangsgleichungen 


y = g{z, X, Xh,) 

(5.3) 

X = yiq, y) 

(5.4) 


anzusetzen. Die Gin. (5.1 )bis (5.4) geben zusammengefaßt die Zustands- und Ausgangs¬ 
gleichungen für den Gesamtautomaten (Steuerung und Steuerungsobjekt). Ähnliches er¬ 
gibt sich bei der Verwendung von Netzen. Das Gesamtnetz setzt sich aus den Teilnetzen 
für die Steuerung und das Steuerungsobjekt zusammen. 

Die Ermittelung der Struktur der entsprechenden Graphen und Netze oder der Funk¬ 
tionen in den Gin. (5.1) bis (5.4) erfogt nach einer zweckmäßigen Strategie, die in den 
nachfolgenden Abschnitten behandelt wird. 

Da es sich sowohl bei der Entwicklung der Aktionssteuerung als auch beim logischen 
Entwurf von Roboterprogrammen im Prinzip um die Behandlung binär gesteuerter 
Abläufe handelt, ist diese Strategie in beiden Fällen (PC-Entwurf und technologische 
Ablaufplanung) in fast gleicher Weise verwendbar. 

Sie haben darüber hinaus noch Bedeutung zur Gestaltung des Teilsystems zur Koordi¬ 
nierung des steuerungsinternen Ablaufs (Echtzeit-Multitask-System). 


5.1.2. Entwurfsstrategie 


Die Strategie für den Entwurf von Steuerungssystemen für diskrete technische Prozesse 
beruht auf der im Bild 5.1 dargestellten Grundstruktur des Steuerungssystems. Sie geht 
davon aus, daß der Entwurfsprozeß sich iterativ und in verschiedenen relativ abgeschlos¬ 
senen Phasen, 

- der Modellierungsphase, 

- der Entwurfsphase und 

- der Realisierungsphase, 

[5.2] vollzieht. 

Zu Beginn des Entwurfsprozesses liegen dem Entwerfer 

- Informationen über das Steuerungsobjekt und die 

- Steuerungsaufgabe 

vor. Die Steuerungsaufgabe legt die zu realisierenden Funktionen auf dem Steuerungs¬ 
objekt - Bewegungsabläufe, Betriebsarten, Verriegelungen u.a. - fest. Der Gewinnung und 
fortlaufenden Präzisierung der Informationen über den zu steuernden Prozeß dient eine 
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Prozeßanalyse [5,1]. Sie hat den Charakter einer theoretischen Prozeßanalyse und führt 
zu einem Modell des Steuerungsobjekts, das auf der Basis des 

- Verhaltens von elementaren Objekten und der 

- Relation zwischen den elementaren Objekten 

ermittelt wird. 

An die Modellierungsphase schließt sich die Entwurfsphase und die Realisierungsphase 
an. 



Bild 5.2. Phasen des Steuerungsentwurfs 


Der Unterteilung in eine Entwurfsphase und Realisierungsphase liegt das Bestreben 
zugrunde, die Steuerung zuerst auf einem strategischen und algorithmischen Niveau zu 
entwerfen und dann diesen Steuerungsalgorithmus mit der speziell ausgewählten Realisie¬ 
rungstechnik praktisch umzusetzen. 

Der in der Entwurfsphase entstehende funktionelle Entwurf ist das Ergebnis eines 
Iterationsprozesses, in dessen Verlauf die Unschärfe der Formulierung der Steuerungs¬ 
aufgabe abnimmt. Der funktionelle Entwurf liefert die Beschreibung der Steuerung mit 
einem vorgegebenen Beschreibungsmittel, das sowohl für die Fachleute der Technologie 
als auch für die des Steuerungssystems in gleicher Weise verständlich sein muß. Die 
ingenieurtechnische Anschaulichkeit läßt dabei grafische Beschreibungsmittel als be¬ 
sonders geeignet erscheinen. Ziel des funktionellen Entwurfs ist es, unabhängig von der 
Form der technischen Realisierung - Hardware oder Software -, eine Beschreibung einer 
Steuerung vorzulegen, die verschiedensten Fachleuten zur Untersuchung auf Voll¬ 
ständigkeit, Widerspruchsfreiheit und Eindeutigkeit dient. 

In der Realisierungsphase oder Implementierungsphase vollzieht sich die Umsetzung 
des funktionellen Entwurfs in Hardwarekomponenten oder Softwarekomponenten des 
zu konfigurierenden Steuerungssystems. 
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5. Aktionssteuerung 


Jeder Entwurf eines Steuerungssystems vollzieht sich gedanklich in diesen drei Phasen. 
Werden die Phasen der Prozeßanalyse und des funktionellen Entwurfs gedanklich vom 
Entwerfer vorweggenommen und dieses Ergebnis unmittelbar in der Realisierungsphase 
als Hardware oder Software niedergelegt, so spricht man vom intuitiven Entwurf. Wer¬ 
den die Phasen jedoch getrennt abgearbeitet und dokumentiert, so spricht man vom 
systematischen Entwurf. Die letzte Vorgehensweise bietet folgende Vorteile: 

- Formalisierbarkeit der Arbeitsschritte der Realisierungsphase, 

- Dokumentation der Steuerungsfunktionen auf dem Niveau des Beschreibungsmittels, 

- Portabilität des Ergebnisses des funktionellen Entwurfs, 

- Anwendung mathematischer Theorien bei der Strukturierung und der Analyse auf 
Vollständigkeit und Widerspruchsfreiheit im funktionellen Entwurf, 

- Aufteilung der Steuerungsfunktionen im Sinne einer Hierarchie. 

Während die Phase des funktionellen Entwurfs schöpferischen Charakter trägt, ist die 
Realisierungsphase weitestgehend formalisierbar. Damit ist die Trennung in Entwurfs¬ 
phase und Realisierungsphase eine Abtrennung der formalisierbaren Anteile des Ent¬ 
wurfs. Sowohl für die Entwurfsphase als auch für die Realisierungsphase ist abgesehen 
von Steuerungsaufgaben geringen Umfangs ein CAD-System auf einem komfortablen 
Arbeitsplatzrechner notwendig. 


5.1.3. Steuerungsrealisierung 

An den funktionellen Entwurf schließt sich die Realisierung der Steuerung an. In dieser 
Phase erfolgt die Umsetzung des funktionellen Entwurfs auf der vorgegebenen Realisie¬ 
rungsbasis. Diese Phase kann für sich noch aufgeteilt werden in einen 

- strukturellen Entwurf - Umsetzung des funktionellen Entwurfs auf das von der Reali¬ 
sierungsbasis geforderte Beschreibungsniveau - 

und einen 

- technischen Entwurf - Konfigurierung der Realisierungsbasis und Fixierung der tech¬ 
nischen Randbedingungen. 

Es wird zwischen einer 

- verbindungsprogrammierten Realisierung mit Logik- und Speicherbausteinen 
und einer 

- speicherprogrammierten Realisierung mit Bitprozessoren und 4-Bit-, 8-Bit- bzw. 16-Bit- 
Mikroprozessoren (z.B. U880, diskreter Bitprozessor) 

unterschieden. Der Zuschnitt der Steuerung auf den betreffenden Anwendungsfall wird 
bei der verbindungsprogrammierten Technik durch Festlegung - Programmierung - der 
Verbindungsstruktur zwischen den Steuerungsbauelementen erreicht und bei der speicher¬ 
programmierten Technik durch Konfigurierung der zur Auswahl stehenden Hardware, 
z.B. E/A-, Speicherbaugruppen u.a., und Software und durch Programmierung des 
Speichers für das Anwenderprogramm. 

Der strukturelle Entwurf muß folglich bei den verbindungsprogrammierten Steuerun¬ 
gen die Ansteuergleichungen für die Logik- und Speicherbausteine liefern und bei den 
speicherprogrammierten Steuerungen das Anwenderprogramm in der für die Steuerung 
festgelegten Sprache ergeben. 

Im einzelnen sind dann bei der Umsetzung des funktionellen Entwurfs die im Bild 5.3 
angegebenen Schritte zu gehen. 
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Bild 5.3. Schritte in der Realisierungsphase 
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Bild 5.4. Niveaus in der Umsetzung des Beschreibungsmittels 
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5 . Aktionssteuerung 


Tafel 5.1. Auszug aus dem DIN-Entwurf 19239 

a) binäre Operationen in Funktionsplänen und Relaisplänen; b) digitale Operationen in Funktionsplänen 
Tafel 5.1a 
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5.2. Mittel zur Funktionsbeschreibung 

5.2.1. ÜberbUck 

Zur Beschreibung der Funktion von Steuerungssystemen zu Steuerung diskreter techni¬ 
scher Prozesse haben sich im Laufe der Entwicklung eine Vielzahl von Mitteln heraus¬ 
gebildet. Diese Beschreibungsmittel waren vielfach an eine neu einzuführende Reali¬ 
sierungsbasis gebunden und haben sich bis heute gehalten. Folgende Mittel sind üblich: 

Diagramme 

In Weg-Schritt-, Weg-Zeit- oder Taktdiagrammen wird der von der Steuerung durch¬ 
zuführende Ablauf beschrieben. Mit Wirkungspfeilen wird die Abhängigkeit zwischen den 
verschiedenen Zeitabläufen charakterisiert. 
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5 . Aktionssteuerung 


Tabellen 

Die bekanntesten Tabellendarstellungen sind die 

- Automatentabelle 

- Entscheidungstabelle. 

Aus diesen Tabellen ist abzulesen, wie sich nach Eintreten einer neuen Prozeßsituation 
der Zustandsübergang - Übergang vom Istzustand zum Nachfolgezustand - vollzieht 
und welche Aktionen auszuführen sind. 

Sprachen (s. Abschn. 6.). 

Schaltpläne und Funktionspläne 

Die Beschreibung der Steuerungsfunktion mit Schaltplänen als 

- Relaisplan 

- Logikplan 

hat sich durch die in der Vergangenheit übliche Realisierung von Steuerungen mit Relais 
oder anderen logischen Bauelementen eingebürgert. Daher wird diese Notierungsform 
auch heute noch für speicherprogrammierte Steuerungen verwendet, obwohl die Reali¬ 
sierungstechnik eine ganz andere ist. Eine Verallgemeinerung dieser Herangehensweise 
findet sich in der Methode der 

- Funktionspläne (Tafel 5.1, DIN 19239) wieder. 

Programmablaufpläne (s. TGL 22451) 

Graphen und Netze 

Die auf der Graphen- bzw. Netztheorie beruhenden Beschreibungsmittel sind ablauf¬ 
orientiert. Die gebräuchlichsten sind 

- Automatengraph 

- Programmablaufgraph (s. Abschn. 5.2.2.) 

- Stellen-Transitions-Netze (s. Abschn. 5.2.3.) 

- Prädikat-Transitions-Netze. 

Mit wachsender Leistungsfähigkeit der speicherprogrammierten Steuerungen setzen 
sich die ablauforientierten Beschreibungsmittel auf der Basis von Graphen und Netzen im 
Zusammenhang mit einer Sprache immer mehr durch. 


5.2.2. Programmablaufgraphen 

Der Programmablaufgraph (PAG) ist aus den in der Rechentechnik zur Notierung von 
Algorithmen bekannten Programmablaufplänen hervorgegangen. In der Darstellung 
lehnt sich der PAG an die Sinnbildmethode (TGL 22451) an. Die Aktionen oder Ope¬ 
rationen werden grafisch durch ein Rechteck dargestellt und mit den durchzuführenden 
Operationen und den zugeordneten Ausgangsgrößen beschriftet. Die binären Entschei¬ 
dungen des Programmablaufplans, dargestellt durch eine Raute, werden im PAG als 
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binäre Funktion der Eingangssignale der Steuerung interpretiert. Das Element hat daher 
zwei Ausgänge: einen, bei dem der Funktionswert 0, und einen, bei dem er 1 ist. Bei der 
Konstruktion des PAG sind folgende Eigenschaften zu beachten: 

• Jede Operation liegt in dem Graph auf einem geschlossenen Weg, der keine weitere 
Operation enthält: 

- Existenz einer Eigenschleife für die Operation. 

• In jedem Programmablaufgraph wird nur immer eine Operation ausgeführt: 

- Eigenschaft einer Zustandsmaschine. 

• Die von einer Operation wegführenden Wege müssen wieder zu einer Operation führen 
und hinsichtlich ihrer logischen Bewertung paarweise disjunkt sein: 

- Widerspruchsfreiheit und Vollständigkeit. 

Ausführliche Erläuterungen findet der interessierte Leser in [5.21]. Ein Beispiel soll 
die Anwendung des Beschreibungsmittels verdeutlichen. Für den Bewegungsablauf einer 
linearen Einzelachse (Bild 5.5) ist vorgegeben, daß die Bewegung mit t = \ gestartet 
wird und so lange anhält, wie t = \ ist. Die Bewegung wird bei t = 0 abgebrochen (Halt). 
Bei erneutem Start der Bewegung wird die Bewegungsrichtung beibehalten. An den End¬ 
lagenschaltern El und E2 erfolgt die Umkehr der Bewegungsrichtung. Beim Einschalten 
der Steuerung wird der Rechtslauf eingenommen. 



Bild 5.5 

Technologisches Modell für eine 
translatorische Achse 


Zwei Varianten des Entwurfs sind im Bild 5.6a und b dargestellt. In der ersten (Bild5.6a) 
werden alle möglichen Zustände dargestellt, während in der zweiten die Zustände nur das 
Gedächtnis für die eingenommene Bewegungsrichtung widerspiegelt. Das Starten und 
Anhalten wird über die Ausgangsgrößen durch logische Verknüpfungen von t mit den 
Zuständen erreicht. 


5.2.3. Netze 

Die Verfahren auf der Grundlage von PAG und Automatengraphen orientieren darauf, 
daß die Zustandsänderungen des Gesamtsystems betrachtet werden. Diese Vorgehens¬ 
weise hat aber den wesentlichen Nachteil, daß die Übersicht über die kausalen Zusam¬ 
menhänge von Zustandsübergängen innerhalb des zu steuernden Systems verlorengeht, 
d.h., man kann aus den unter dem Aspekt der Zusammenfassung zusätzlich zu den 
sequentiellen Prozessen entstandenen Sequenzen nicht mehr diejenigen erkennen, die tat¬ 
sächlich in einem ursächlichen Zusammenhang stehen. Außerdem besteht ja das Ziel 
einer Prozeßbeschreibung letztlich darin, diese in eine entsprechende Steuereinrichtung 
abzubilden bzw. umzusetzen. Bei einem hinreichend großen System, bei dem ein ein- 
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Bild 5.6. Beispiel der Beschreibung der Steuerung der translatorischen Achse mit PAG 

a) Steuerung Variante 1; b) Steuerung Variante 2 


zelner Bearbeiter nicht mehr in der Lage ist, alle systemrelevanten Vorgänge auf einmal 
zu überblicken, erscheint es mit vertretbarem Aufwand kaum möglich, ein für alle Teil¬ 
komponenten gemeinsames Zeitraster a priori herzustellen. 

An einem kleinen Beispiel soll dieser Sachverhalt verdeutlicht werden. Bild 5.7a zeigt 
zwei Automatengraphen A und A', die jeweils eine Positionierungssteuerung einer Werk- 
zeug-(Werkstück-)palette mit den drei Positionen 0, 1 und 2 beschreiben sollen. Die 
jeweiligen Zustandsübergänge a, bzw. bi werden aus den Eingangsvariablen auf eine hier 
nicht näher zu beschreibende Art und Weise ermittelt; ihre Reihenfolge liegt jedoch in 
Form der beiden ableitbaren sequentiellen Prozesse (oi , 02 , a^, Ui, a 2 ...) bzw. 
{bi,b 2 , Z> 3 , Z?!, 62 ...) fest. 

Wären die in ihren Teilsystemen ablaufenden Prozesse völlig voneinander unabhängig, 
so könnte man das Gesamtsystem durch einen Zustandsgraphen mit neun Zuständen 
und allen entsprechenden Übergängen abbilden. Dieser Fall ist aber praktisch nicht von 
Interesse, da unverkoppelte nebenläufige Prozesse selbstverständlich auch unabhängig 
beschrieben und gesteuert werden können. Wesentlich problematischer wird die Be¬ 
schreibung, wenn aus der Aufgabenstellung oder Prozeßbeobachtung Verkopplungen 
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ableitbar sind, etwa in der Art: Zustandsübergang in A' kann nur erfolgen, wenn die 
ihn implizierenden Eingangsvariablen im Zustand 0' wahr sind und vorher der Zustands¬ 
übergang öl in A erfolgt ist, der Übergang hänge in gleicher Weise von ab. 

Eine solche Verkopplungsbedingung könnte beispielsweise die Folge der Aktivitäten 
eines Beschickungs- oder Montageroboters sein, der mit beiden Paletten arbeitet. Im 
Bild 5.7b ist der Zustandsgraph des Gesamtsystems dargestellt, der durch Zusammen¬ 
fassung gleichzeitig vorliegender Zustände der Teilautomaten A bzw. A' entsteht. Dabei 
wurde die topologische Anordnung der Teilprozesse beibehalten, so daß die Übergänge ö; 
wieder in horizontaler und die Übergänge bt in vertikaler Richtung verlaufen. Interessant 
ist, daß zwei Hilfsvariablen (i bzw. 3') eingeführt werden mußten, um einen der Aufgabe 
gerechten und determinierten Automaten zu erhalten. Dies liegt eindeutig an der Ver¬ 
kopplungsbedingung, da jetzt z. B. der Zustand (70') eingenommen werden kann, nach¬ 
dem der Übergang b^ noch nicht stattgefunden hat (70' 5) oder nachdem der gesamte 
Teilprozeß {bi, 62 , ^ 3 ) abgelaufen ist (70' 3'). Dies gilt sinngemäß auch für die zusam¬ 
mengefaßten Zustände (20') (12') und (22'), die gemäß Bild 5.7b ebenfalls je in zwei 
Zustände aufgespaltet werden. 

Im Bild 5.7 b sieht man, daß das zeitliche Verhalten des horizontalen Prozesses darüber 
entscheidet, welchen der fünf möglichen Zustände der vertikale Prozeß nach dem Zu¬ 
standsübergang 02 einnimmt. Ziel einer Beschreibung kann aber nur ein determiniertes. 





Bild 5. 7 . Gegenüberstellung der Beschreibung paralleler Abläufe 

a) Darstellung der sequentiellen Teilabläufe mittels Automatengraphen (AG); b) Darstellung des verkoppelten Ablaufs mittels 
AG; c) äquivalente Darstellung von a) mit BE-Systemen; d) Darstellung des verkoppelten Gesamtablaufs mit BE-Systemen 
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5 . Aktionssteuerung 


also von zufälligen Zeitbedingungen freies und somit zeitinvariantes System sein, will 
man sich nicht der Arbeit einer Analyse aller denkbaren zeitlichen Varianten der Prozeß¬ 
verläufe unterziehen. Dabei ist das Erkennen des Kausalgefüges, d.h. Ursache-Wirkung- 
Beziehung eines Systems nicht nur für den Fall parallel zueinander ablaufender Prozesse 
interessant, sondern es ermöglicht auch bei rein sequentiellen Problemstellungen eine 
große Variantenvielfalt für die Realisierung. So muß eine einmal willkürlich festgelegte 
Sequenz nicht immer die optimale Lösung sein; ihre Änderung ist aber nur dann möglich, 
wenn Aussagen darüber vorliegen, welche Elemente der gewählten Sequenz permutiert 
werden können und welche aus den Gegebenheiten des Steuerobjekts heraus tatsächlich 
in der angegebenen Reihenfolge ausgeführt werden müssen. Diese Überlegungen führten 
C.A.Petri zur Begründung seiner nach ihm benannten Netztheorie [5.9] [5.23], deren 
Grundlage die sog. Bedingung-Ereignis-Systeme (BE-Systeme) darstellen. Die angestrebte 
Ursache-Wirkung-Beziehung wird in den BE-Systemen ausgedrückt durch die Paare 
Ereignis-Bedingung bzw. Bedingung-Ereignis, und der Zustand des Systems wird durch 
die Angabe der jeweils geltenden Prozeßbedingungen charakterisiert, d.h. also durch 
eine Menge nebenläufiger und damit kausal unabhängiger Bedingungen. Zur Unter¬ 
scheidung vom Zustandsbegriff in der Automatentheorie führte Petri den Begriff des 
Falls ein. 

Die grafische Darstellung aller möglichen Fälle eines Systems heißt Fallgraph 
(B, E, F, Rf), wobei B die Menge der Bedingungen, E die Menge der Ereignisse und F 
die Menge der Fälle darstellt, die wiederum über die Relation Rp miteinander verknüpft 
sind. Für Fund Rp gilt dabei 


F S P{B) 

(5.5) 

Rp c F X F X F. 

(5.6) 


Ein Fall / wird also durch Eintreten eines Ereignisses e in einen anderen Fall /' über¬ 
führt, was im Netz der verknüpften Bedingungen und Ereignisse bedeutet, daß e ein- 
treten kann, wenn alle seine Vorbedingungen und keine seiner Nachbedingungen erfüllt 
sind. Man sagt: e hat Konzession. Durch das Eintreten von e wird die Existenz der Be¬ 
dingungen von Fall /beendet, und es werden die Bedingungen von Fall /' erfüllt. Es soll 
dabei gelten, daß jedes Ereignis in mindestens einem Fall Konzession hat, sonst kann es 
nie eintreten und somit weggelassen werden. Der entstehende Fallgraph soll außerdem 
stark zusammenhängend sein, wodurch jeder Fall in jeden anderen Fall überführt 
werden kann. Damit sind Bedingungen und Ereignisse im Netz durch die Relation V mit 

V^BxEkjExB (5.7) 

verknüpft. Als grafische Darstellung werden für die Bedingungen Kreise, für die Ereig¬ 
nisse Striche oder Kästchen, für die Verbindungen Pfeile und für die Fälle Punkte in den 
Kreisen angegeben (Bild 5.8 a). Die Punkte in den Kreisen geben die Markierung des 
Systems an. Unter einer Markierung m wird die Abbildung 

m:F->{0, 1} (5.8) 

verstanden, und zwar so, daß für einen Fall / gilt 
fl, . falls e/ 

mm = (5.9) 

[0 sonst. 

In der grafischen Darstellung bedeutet m{b) = 1, daß in dem zugehörigen Bedingungs¬ 
kreis eine Marke (dargestellt als Punkt) eingetragen ist. 
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Bereits mit diesen einfachen Grundbegriffen und Hilfsmitteln ist es möglich, das zu 
steuernde System nach Bild 5.7b wesentlich übersichtlicher und vor allem korrekt und 
invariant zu beschreiben. Bild 5.7c zeigt die beiden Prozesse und Bild5.7d ihre Ver¬ 
kopplung. Die Bezeichnungen der Zustände bzw. Übergänge wurden dabei auf die Be¬ 
dingungen bzw. Ereignisse übertragen. Dabei werden den Ereignissen die Zustands¬ 
übergänge und den Bedingungen die Zustände der Teilautomaten zugeordnet, Während 
die Gesamtzustände von Bild 5.7 b jeweils einem Fall (einer erreichbaren Markenkonstel¬ 
lation) des Netzes entsprechen. Ein Ereignis kann demnach eintreten, wenn seine Vor¬ 
bedingung (je eine Marke in allen Vorplätzen in der Darstellung) und die Übergangs¬ 
bedingung vom Automatengraphen (ö^ bzw. 6 ,) erfüllt sind. Mit dieser Beschriftung wird 
für BE-Systeme bereits eine mögliche Interpretation ihrer Elemente deutlich. 

Ohne Schwierigkeiten lassen sich auf der Grundlage dieses Modells die Ereignispaare 
angeben, die parallel zueinander ablaufen können und somit kausal unabhängig sind. 

Man muß dazu untersuchen, ob die entsprechende Konstellation der Bedingungen als 
Fall existiert oder nicht. So ist z.B. (00' 3) kein Fall, was der schon a priori bekannten 
Tatsache der kausalen Abhängigkeit des Ereignisses by vom Ereignis Oi entspricht. Da¬ 
gegen gilt (10'3) e F, und somit sind die Ereignisse 02 und bi nebenläufig. Es sei an dieser 
Stelle darauf hingewiesen, daß Nebenläufigkeit (oder Parallelität) zweier Ereignisse nicht 
notwendig deren gleichzeitiges Eintreten impliziert, sondern nur diese Möglichkeit ein¬ 
schließt. Postuliert man Ereignisse der Dauer 0 in Verbindung mit der Unteilbarkeit eines 
Ereignisses, so verschwindet die Gleichzeitigkeit praktisch sogar völlig, weil die Auftritts¬ 
wahrscheinlichkeit dann ebenfalls 0 ist. 

Wegen der weiteren „Nicht-Fälle“ (0 1'), (2 V 3') und (2 0' 3 3') sind neben (ay , by) 
die Ereignispaare (üy , by ,) ( 62 » ^3) und (by, a^) kausal abhängig, alle anderen aber paar¬ 
weise nebenläufig. Zeichnet man den gesamten Fallgraphea auf, so entsteht exakt der 
Automatengraph vom Bild 5.7b. Die Überführbarkeit eines Bedingung-Ereignis-Systems 
in einen endlichen Automaten ist eine wichtige Eigenschaft, vor allem im Hinblick auf die 
Analyse der Korrektheit einer Beschreibung. 

Da die Beschreibungskraft der BE-Systeme zur Beschreibung komplizierter Systeme 
und Prozesse etwas zu gering ist, werden höhere Netzebenen mit größerer Beschreibungs¬ 
kraft geschaffen. Von diesen sollen im weiteren, auch als Grundlage für die Anwendung 
zur Steuerung diskreter technischer Prozesse, die sog. Stellen-Transitions-Netze (S/T- 
Netze, Petri-Netze), angegeben werden. Dabei werden die Bedingungen zu den sog. 
Stellen verallgemeinert, die jetzt seine bestimmte Anzahl von Marken (Maximum 
= Kapazität des Platzes) tragen können und somit als Speicher oder Zähler für Marken 
verwendet werden. Analog dazu erhalten die Verbindungen eine Vielfachheit, die die 
Anzahl der zu transportierenden Marken angibt. Daraus ergibt sich eine neue Schaltregel 
für die jetzt als Transitionen bezeichneten Ereignisse des BE-Systems, die u. a. die Marken¬ 
anzahl berücksichtigt. Außerdem sind jetzt auch Schlingen (Bild 5.9) möglich, die, wie 
später noch gezeigt wird, zur Realisierung von Testfunktionen sehr wesentlich sind. 

Ein anschauliches Beispiel für die Unterschiede in der Beschreibungskraft von BE- 
Systemen und S/T-Netzen wird im Bild 5.8 a und b gezeigt, wobei ein Zähler modulo 3 
modelliert wird, d.h., es soll das Verhaltensschema eyeyeye 2 eyeyeye 2 ey... erzwungen 
werden. Zur Realisierung als BE-Systeme sind die Hilfsereignisse hy und Ä 2 notwendig, 
die für den Systemzusammenhang unwesentlich sind. Genauere Ausführungen zu der 
Netzproblematik findet der interessierte Leser in [5.9] [5.23]. 

Soll die bisher aufgestellte allgemeine Theorie der Netze auf einem bestimmten Gebiet 
appliziert werden, so bedarf es einer entsprechend problemangepaßten Interpretation 
der Netzelemente und einer evtl, notwendigen Modifikation ihres Verhaltens. Damit ent- 


11 Industrierobotersteuerung 
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Bild 5.8. Verallgemeinerung der BE- Bild 5.9. Schlingen im SjT-Nefz 

Systeme zu Stellen-Transitionsnetzen 

a) BE-System eines Modulo-3-Zählers 

b) Darstellung als S/T-Netz 


Stehen spezielle Netztheorien, die sich in den letzten Jahren in vielen Gebieten von Natur¬ 
wissenschaft und Technik geradezu stürmisch entwickelt haben. 

Im folgenden sollen zwei Interpretationen vorgestellt werden, die bei der Modellierung 
und Realisierung von Steuerungen diskreter technischer Prozesse einen großen Teil der 
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Bild 5.10. Interpretation der SjT-Netz-Elemente für SN und AKN 
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anfallenden Aufgabenstellungen abdecken können. Die entstehenden Netzklassen werden 
als sog. Steuernetze (SN) bzw. Ablaufkontrollnetze (AKN) bezeichnet und dienen der Be¬ 
schreibung einfacher binärer Steuerungen und deren Hardware- oder Softwarerealisie¬ 
rung (SN) bzw. der Beschreibung von Echtzeitsteuerprogrammen für softwareorientierte 
Implementierungen allgemeiner Automatisierungsprobleme (AKN). 

Bild 5.10 zeigt die Zuordnung der Elemente aus dem jeweils problemspezifischen Be¬ 
schreibungsraum der beiden Netzinterpretationen zu den Elementen (5, T, V, Mq) des 
uninterpretierten S/T-Netzes. 

Im weiteren folgen einige Erläuterungen zu den einzelnen Netzklassen. 


Steuernetze (SN) 

Die Darstellung und Beschriftung von Stellen und einfachen Transitionen ist Bild 5.11 zu 
entnehmen. Bei Makrotransitionen wird mit dem vergebenen Namen ein Teilnetz be¬ 
zeichnet, das allerdings eine bestimmte Eigenschaft, die sog. Wohlstrukturiertheit [5.24], 
haben muß. Im wesentlichen bedeutet dies, daß das Teilnetz korrekt (lebendig) ist und 




Bild 5.11 

Verfeinerung von Netzmakro¬ 
transitionen 


Etcisfenzkarfe 



Inhlbitorkanfe 

O-H 



Bild 5.12. Kantenmodifikationen im SN 

a) Darstellung der Testkanten; b) Beispiel einer Konfliktlösung mittels Testkanten; c) Rückkonstruktion der Testkanten 
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genau eine Start- und genau eine Stoptransition besitzt, zwischen denen sich eine Stelle 
mit der Initialmarkierung befindet, die beim Ersetzen weggelassen wird. Bild 5.11 zeigt 
eine Beispielkonstruktion. Die Testfunktionen von Verbindungselementen erstrecken 
sich auf die Überprüfung des Vorhandenseins (Existenzkante) oder Nichtvorhanden¬ 
seins (Inhibitorkante) einer Marke auf einer beliebigen Stelle. Diese Einschränkung ist 
möglich, weil in Steuernetzen ohnehin alle Stellen die Kapazität 1 haben, d.h., SN sind 
(0,l)-markierte Netze. Die Darstellung der genannten Kanten und ihre mögliche Rück¬ 
überführung in Elemente des S/T-Netzes wird im Bild 5.12 gezeigt. Dabei wird für die 
Inhibitorkante eine sog. Co-Stelle (negierte Stelle) eingeführt (Bild 5.12c). 

fei fe-, 




Bild 5.13. Vergleich der Beschreibungsmittel 

a) Automatengraph zum PAG von Bild 5.6 b; b) Steuernetz zum PAG von Bild 5.6 b 

Ein kurzer Vergleich der Beschreibungsmittel Steuernetz, Programmablaufgraph und 
Automatengraph am Beispiel der Supportsteuerung ist dem Bild 5.13 zu entnehmen, wo¬ 
bei der Automatengraph einer speziellen Klasse von Steuernetzen, der Zustandsmaschine, 
gleichzusetzen ist. Da mit Steuernetzen parallel ablaufende Prozesse in einer geschlos¬ 
senen Darstellung erfaßbar sind, ergibt sich bei der Nutzung einer Ausgangstabelle zur 
Darstellung der Stellgliedansteuerung folgende Besonderheit: 

In den Spalten sind (wegen der möglichen gleichzeitigen Markierung von Plätzen) nur 
dann Eintragungen vorzunehmen, wenn ein Platz eine definierte Wirkung auf ein Stell- 



Bild 5.14. Möglichkeiten der Nutzung von Steuernetzen zur Darstellung von a) zeit- und ereignis¬ 
bedingten Prozessen; b) Eröffnung und c) Synchronisation von Parallelarbeit; d) symbolische Darstellung 
der Einnahme des Anfangszustands aus jedem beliebigen Zustand heraus 
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Signal haben soll. Dementsprechend sind die Stellsignale nur von markierten Plätzen 
aus der Ausgangstabelle abzuleiten. 

Das Entwurfsmittel Steuernetz bietet auch Möglichkeiten, realisierungsabhängige Be¬ 
sonderheiten einzuarbeiten. Wie im Bild 5.14 die ereignis- und zeitabhängige Schaltfähig¬ 
keit von Transitionen erfaßt wird, so können vom jeweiligen Entwerfer auch andere Be¬ 
sonderheiten oder Vereinbarungen eingearbeitet werden, die jedoch den angegebenen 
Regeln und Eigenschaften entsprechen müssen. Ein Beispiel dafür ist die Einfügung von 
komplexen logischen Ausdrücken in die Ausgangstabelle, so daß ähnlich dem Programm¬ 
ablaufgraphen ein Mealy-Automat erzeugt wird. 

Die Verwirklichung bestimmter Not-Aus-Funktionen technischer Realisierungen bringt 
bei Einhaltung der Regeln ähnliche Probleme. Hierbei ist es sinnvoll, in einer sehr 
groben Darstellungsstufe, die dem eigentlichen Steuernetz des Prozeßablaufs überlagert 
ist, eine generelle Überführung der momentanen Markierung in die Anfangsmarkierung 
darzustellen (das spart spezielle Knoten und Kanten zum Markenabzug bei Einhaltung 
der geforderten Netzeigenschaften ein und wird nicht der Netzanalyse unterzogen) bzw. 
spezielle Wege in Teilnetzen einzuführen (vgl. Beispiel Abschn. 5.4.3. und Bild 5.14d). 


Ablaufkontrollnetze (AKN) [5.10] 

Im AKN werden sequentielle Teilprozesse (TASK) und deren Verkopplung dargestellt. 
Die Task bestehen aus internen Stellen (repräsentieren den Tastkzustandsvektor), externen 
Koppel-(Synchronisations-) Stellen mit der Kapazität 1 und Prozeduren in Form von 



Bild 5.15 

Elemente des Ablaufkontrollnetzes 
a) Taskdarstellung; b) Interruptmarkierung; c) Zeitfunktion 



Aktionstransitionen, die über globale Variable auf den Steuerfluß einwirken können 
(Bild 5.15a). Außer über die Eingabefunktionen der Prozeduren können Eingangsvariable 
Xi auch über Interrupt, dargestellt durchjnterrupt-(Ereignis-) Transitionen, an die Steue¬ 
rung gelangen (Bild 5.15 b). Bei den Verbindungen gilt prinzipiell das unter den Steuer¬ 
netzen Gesagte, wobei hier aus implementierungstechnischen Gründen (s. Abschn. 5.5.4.) 
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auf die Kantenvielfachheit verzichtet wurde. Die Zeitfunktion steckt zum einen implizit 
in den Laufzeiten der Prozeduren; zum anderen besteht die Möglichkeit, auch innerhalb 
von Aktionstransitionen speziell spezifizierte Stellen zeitabhängig (verzögert) zu mar¬ 
kieren (Bild 5.15c). 


5.3. Modellbildung 


Beim Entwurf von Steuerungen auf Personalcomputern wird die Überprüfung des 
Steuerungsentwurfs vielfach nicht am realen Steuerungsobjekt, sondern an einem Modell 
durchgeführt. Je nach Art der Zielvorstellungen zur Simulation und des Betrachtungs¬ 
niveaus können verschiedene Simulationssysteme und damit Modellierungsmethoden 
zur Anwendung kommen. 

Für den Bereich der Fertigungssysteme ist der Prozeß im wesentlichen durch Orts- 
(Lage-) Größen und Energiegrößen gekennzeichnet. Für die Modellierung ist dann zu 
entscheiden, ob mit der Simulation Aussagen über den Werkstückfluß im Fertigungs¬ 
system oder über das Verhalten der ungesteuerten Teile des Fertigungssystems - Roboter, 
Werkzeugmaschine und Transportsystem - erhalten werden sollen. Während für die Aus¬ 
sagen zum Werkstückfluß nur eine globale Modellierung der Teilsysteme notwendig ist, 
benötigt man in anderen Fällen detaillierte Aussagen über das Verhalten der Teilsysteme. 
In diesem Sinne soll unterschieden werden in 


- globale Modelle 

- lokale Modelle. 


Masse 


I 



Support 


a) 




d'r 

yz 

ya 

Ci 

Gz 


Links lauf 
Rechtslauf 
Motor EIN/AUS 
Ort x.„ eingenommen 
Or'tXf.fTj eingenommen 


Bild 5.16 

Modellierung einer translatorischen Achse 
a) Schema; b) Zustandsebene; c) Modell als Netz formuliert 


Ein System, das auf der Basis von globalen Modellen Simulationsaussagen zu Werkstück¬ 
fluß und Belegungszeiten bzw. Verweilzeiten liefert, ist das Simulationssystem SIMDIS 
[5.25]. Da diese Betrachtungen hier nicht im Vordergrund stehen, soll im folgenden nur 
auf die lokalen Modelle eingegangen werden. 
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Bei den lokalen Modellen wird eine Modellierung der bewegten Funktionseinheiten 
des zu steuernden Objekts angestrebt. Im Fall der Roboter und Werkzeugmaschinen, 
allgemein bei Fertigungssystemen unterscheidet man [5.2]: 

- lagebestimmte Funktionsseinheiten 

Lagebestimmte Funktionseinheiten sind vor allem Vorschubachsen - translatorische 
Achsen, rotatorische Achsen usw. - und Transporteinrichtungen. Sie besitzen ohne 
Energiezufuhr beliebig viele stabile Lagen. Die charakterisierende Größe ist immer ein 
Orts-Zeit-Verlauf. 

- energetisch bestimmte Funktionseinheiten. 

Energetisch bestimmte Funktionseinheiten sind vor allem elektrische Antriebssysteme 
und hydraulische Systeme. Die charakterisierende Größe ist stets eine Energie - 
Energie des Magnetfelds usw.-oder eine Ersatzgröße, die die Energie ausreichend be¬ 
stimmt. 

Die Modellbildung soll an einem einfachen Beispiel einer translatorischen Achse mit 
zwei Endlagenschaltern erläutert werden. Im Abschn. 4. wurde dafür die Bewegungs¬ 
gleichung diskutiert und die Zustandstrajektorien f{x, x) für eine optimale Steuerung im 
Bild 5.25 dargestellt. Bei einer gröberen Betrachtung der Funktionseinheit (Bild 5.16a) 
interessieren nur ausgewählte Gebiete bzw. Punkte in der Zustandsebene. Im Beispiel 
sind dies der rechte Randpunkt x„, der linke Randpunkt und die x-Achse für den 
Zustand „Ruhe“. Die Quadranten I und II stehen für den Zustand „Linksbewegung“ und 
die Quadranten III und IV für den Zustand „Rechtsbewegung“ (Bild 5,16b). Damit ge¬ 
winnt man bei einer Beschreibung mit einem steuerungstechnisch interpretierten Netz das 
Bild 5.16b. Eine Steuerung für diese Achse kann die im Bild 5.13 angegebene sein. 


5.4. Funktioneller Entwurf 

5.4.1. Überblick 

Der Stand des funktionellen Entwurfs ist gegenwärtig dadurch gekennzeichnet, daß auf 
ein Modell des Steuerungsobjekts verzichtet wird und der funktionelle Entwurf aufgrund 
der Formulierung der Steuerungsaufgabe (s. Bild 5.3) erstellt wird. 

Wenn das Verhalten des Steuerungsobjekts von Fall zu Fall doch beschrieben wird, so 
wird in der Regel die Beschreibung von Teilabläufen der erst noch zu entwerfenden 
Steuerung mit der Beschreibung des Steuerungsobjekts stark miteinander vermischt. Im 
folgenden soll der funktionelle Entwurf ohne Erstellung eines Modells behandelt werden. 

Es sei nochmals erwähnt, daß von den technologischen Anforderungen ausgehende 
genaue Kenntnisse der gewünschten Bewegungsabläufe, Betriebsarten, Funktionen und 
Verriegelungen vorliegen müssen. Daran schließen sich Vorstellungen zur hierarchischen 
Strukturierung an. Diese Strukturierung ist jedoch in Wechselwirkung mit der Realisie¬ 
rungsphase zu stellen. 


5.4.2. Entwurf mit Steuemetzen oder PAG 

Der Umfang, die angestrebte Servicefreundlichkeit und die geforderte Änderbarkeit von 
Robotersteuerungen und Maschinensteuerungen bringen es mit sich, daß eine Zerlegung 
in Teilsteuerungen unumgänglich ist. Der Entwurf der Steuerungshierarchie und der 
Festlegung des funktionellen Inhalts der Teilsteuerung erfolgt intuitiv. Bild 5.17 zeigt eine 
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prinzipielle bewährte Form für Ablaufsteuerungen. Gesichtspunkte für eine Zerlegung in 
Funktionsgruppen bzw. Moduln ergeben sich aus 

• konstruktiv-technologischer Sicht 

- Ableitung von Elementarmoduln (Betätigung der Greifer, Verfahren einer Achse, 
Positionieren auf einen numerisch vorgegebenen Sollwert usw.; 

- Realisierung technologischer Teilfunktionen unter Einbeziehung von Elementar¬ 
moduln (Entnahme eines Rohteils aus der Palettfe, Einlegen eines Rohteils in die 
Maschine usw.); 

- Zusammensetzung eines gesamten technologischen Funktions- bzw. Bewegungs¬ 
zyklus aus Teilfunktionen mit Hilfe eines Koordinators; 

- Auswahl verschiedener technologischer Funktions- bzw. Bewegungszyklen durch 

Einführung von Subkoordinatoren, die den Koordinator modifizieren, indem sie 
verschiedene Wege im Koordinator auswählen (Bestimmung des aktuellen Paletten¬ 
platzes, Auswahl der Maschinenposition, Auswahl bestimmter Bewegungskombi¬ 
nationen usw.), ' 

• steuerungstechnischer Sicht 

- Funktionsgruppe Steuerung EIN (Herstellen der Betriebsbereitschaft); 

- Bildung steuerungstechnischer Signale (Startbedingung, Grundstellung, Vermeidung 
von Kollisionen, Havarien); 

- Reihenfolge des Zuschaltens zentraler Einrichtungen (Hydraulik, Druckluft, elek¬ 
trischer Leistungsteil); 

- Realisierung von Not-Aus; 

- Betriebsartenauswahl (Start-Stop-Halt, 1 x-Durchlauf, Anfangs-und Endebehand- 
handlung, Automatik, Tipp-, Handbetrieb); 

- Fehleranzeigen; 

- Reaktionen auf Fehler; 

- Beherrschung zeitlicher Effekte (Impulsbildung, Direkteingaben, Interruptverarbei¬ 
tung, zeitliche Überdeckung von Teilmoduln); 

- Bestimmung der Reihenfolge der Abarbeitung der Programmteiler (entfällt bei 
Polingbetrieb), 

• dialogtechnischer Sicht 

Die zugehörige Dialogsteuerung soll sich dabei nicht auf die normale Roboterbedie¬ 
nung bei ausgetesteten Programmen beziehen, sondern Funktionen enthalten, die die 

Erstinbetriebnahme, Fehlersuche und -lokalisierung, Programmkorrektur und -ände- 

rung, Programmeingabe, Programmdokumentation beinhalten. Stichwörter sind hier 

- Diagnoseprogramme, 

- nachladbares oder residentes Dialogprogramm, 

- Programmiergerät, 

- Teach-in-Programmierung. 

Für die Hierarchiebildung und Zergliederung der Gesamtfunktion gibt es beim PAG und 
beim Steuernetz keine Unterschiede. Auch werden in beiden Fällen Zustandsmaschinen 
zur Beschreibung elementarer Abläufe benutzt. Unterschiede bestehen bei der Kopplung 
der elementaren PAGen und der Steuernetze: 

PAG: Kopplung zwischen PAG wird durch Setzen von Koppelvariablen über die 

Operationen und Abfragen dieser in den anderen PAG in den Verzweigungen 
SN: Kopplung durch Überlagerung der Zustandsmaschinen. 




Bild 5.18. Technologische Einheit 

a) Anordnung der Komponenten in der technologischen Einheit; b) prinzipieller Aufbau des 1R2/SII 
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Im folgenden soll an einem Demonstrationsbeispiel die Anwendung des Entwurfs¬ 
verfahrens mit Steuernetzen erläutert werden [5.14]. Dieses Beispiel entstand auf der 
Grundlage von technisch realisierten Programmen für den Beschickungsroboter IR 2/S II 
[5.15] [5.16]. Dieser Roboter ist in eine technologische Einheit (TE) mit zwei Werkzeug¬ 
maschinen (WZM 1,2) und zwei Werkstückspeichern (SPEI 1,2) integriert und dient der 
Beschickung der WZM mit Rohteilen (Bild 5.18). 

Die Steuerung des Roboters übernimmt eine speicherprogrammierbare Steuerung 
(Typ IRS 2000), die Boolesche Gleichungen verarbeitet und somit eine Punkt-zu-Punkt- 
Steuerung ermöglicht. Positions- und Geschwindigkeitsregelungen sind Hardware¬ 
funktionen. Dabei ist die An^hl der möglichen Positionen je Achse: 

- C-Achse 4 

- A-Achse 4 

- X-Achse 10 (Sollwerte KIX bis KlOX, KlOX = X-Achse hinten) 

- Z-Achse 20 (Sollwerte KIZ bis K20Z, K20Z = Z-Achse oben, K19Z = Aushub AZ) 

- Y-Achse 2. 

An der yl-Achse sind zwei Greifer für die Rohteil- (GR) und Fertigteilhandhabung 
(GF) installiert. Die Werkstückspeicher besitzen sechs Ebenen mit jeweils sechs Werk¬ 
stückplätzen und sind vor Entnahme eines Teiles jeweils um eine Position weiterzudrehen 
(takten). Aufgabe des Roboters ist es, die anfordernde Werkzeugmaschine (WZM 1 
oder 2) mit Rohteilen vom entsprechenden Werkstückspeicher (SPEI 1 oder 2) zu be¬ 
schicken (WZM leitet Fertigteil selbständig weiter). 

Der Abbruch der Beschickung erfolgt nach Erkennung des letzten Werkstücks des 
Loses (LWL), woraufhin der Roboter seine definierte Grundstellung einzunehmen hat. 

Als mögliche Betriebsarten wurden der Automatikbetrieb AUT (Koordinator organi¬ 
siert die Bewegungsfolge) und der Handbetrieb HA (Erfassung in den entsprechenden 
Elementarmoduln) realisiert, wobei der Automatikbetrieb durch die Anwahl von STOP 
oder HALT (am Zyklusende) unterbrochen werden kann. 

Die Steuerung ist aus insgesamt 29 Moduln (Funktionsgruppen FG) konzipierbar und 
kann folgendermaßen hierarchisch gegliedert werden: 

Steuerungstechnische Funktionsgruppen 

FG 1 Steuerung EIN (zur Auswertung von Not-Aus-Signalen) 

FG 2 Hilfsenergie zuschalten (Hydraulik EIN) 

FG 3 Drucküberwachung Hydraulik Pumpe 2 

FG 4 Schutzgitter - Kontrolle und Betätigung 

FG 5 bis 8 Kontrollen, Fehlermeldungen 
FG 9 Kontrolle der Grundstellung des Roboters (GS) 

FG 10 Betriebsartenauswahl und -realisierung. 

Konstruktiv-technologische Funktionsgruppen 

- Koordinator = FG STW (Steuerwerk) 

- Subkoordinatoren 

FG 21 Unterscheidung der Maschinen (WZM) 

FG 22 Auswahl der Speicher 

FG 23 letztes Werkstück des Speichers/Loses (LWS/LWL), 

- Teilmoduln 

FG 1/1 Entnahme Rohteil aus SPEI 
FG 43 Rohteil in WZM einlegen 
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- Elementarmoduln 
Bewegungsmoduln 
FG 11 Schwenken C-Achse 

FG 12 Schwenken ^-Achse 

FG 13 7-Achse 

FG 15/1,2 Greifer Roh-/Fertigteil 
FG 16 7-Achse Handbetrieb 

FG 17 Z-Achse Handbetrieb 

FG 18 Aushub AZ Handbetrieb 

Zähler 

FG 19/1,2 Ebenenzähler der SPEI 1, 2 
FG 20/1,2 Rohteilzähler für WZM 1, 2 
Peripheriemodul 
FG 14/1,2 Takten der SPEI 1, 2. 


Der Kopplung Robotersteuerung-WZM dienen die Signale PEA (IRS WZM, akti¬ 
viert Bewegungen in WZM) undPEE (WZM IRS, meldet abgeschlossene Aktivitäten), 


£ kOP (Aktivierung) 


1 


koordinafor 

RkOP 

Teilmodul 

(Teilmodul) 

(Ende-Meldung ) 

(Elementarm.) 


I 


A kOP (Endaktivierung ) 


RTM gemeinsamer 
Ruhezustand 



EKOPr, Ruhezustand 



b) koordinafor Teilmoduln 


Teil- \ Efemenfarmodute 
^modu! GR, 6F, Y-Achse 



d) 


Bild 5.19 

Kopplung von Funktionsgruppen unterschiedlicher 
Hierarchieebenen 

a) Prinzip; b) Realisierung der Schnittstelle im Steuernetz 
bei der Kopplung von Teilmoduln an den Koordinator; 
c) Realisierung der Schnittstelle im Steuernetz bei der 
Kopplung des Koordinators der Teilmoduln mit Elementar¬ 
moduln; d) Realisierung der Schnittstelle im Programm¬ 
ablaufgraph 
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die in Moduln verschiedener Hierarchieebenen gebildet bzw. getestet werden (s. auch 
Bild 5.18 a). Eine Dialogsteuerung existiert in diesem Anwendungsfall nicht. 

Um die Funktionsgruppen unterschiedlicher Hierarchieebenen verbinden zu können, 
werden in diesem Beispiel Koppelsignale (Plätze) eingeführt (Bild 5.19). Diese Signale 
sind 

EKOP Einkoppeln von Teil- oder Elementarmoduln (Aktivierung) 

AKOP Auskopplung von Teil- oder Elementarmoduln (Entaktivierung) 

RKOP Rückmeldung des aktivierten Moduls an den aufrufenden Modul. 

Diese Koppelbeziehungen können in den verschiedenen Entwurfsmitteln unterschied¬ 
lich realisiert werden. Daraus ergibt sich die Möglichkeit, in den verschiedenen Hier¬ 
archieebenen gleiche oder unterschiedliche Entwurfsmittel anzuwenden. Beispielsweise 
können Koppelsignale im PAG als Ausgangssignale von Zuständen des aufrufenden 
PAG gebildet und in Übergangsbedingungen des aktivierten PAG abgefragt werden. 

Dagegen sind im Steuernetz die Koppelsignale als Plätze (Koppelplätze) dargestellt 
und somit mit einem Markentransport verbunden. Zu erwähnen ist noch, daß in dieser 
Art die Koppelsignale nur in der Betriebsart Automatik, also bei Aktivitätssteuerung 
durch den Koordinator, wirksam sind. 

Die Betriebsart Hand wird in den entpsrechenden Elementarmoduln durch besondere 
Wege im Graphen realisiert. Daraus ergibt sich auch die Notwendigkeit, daß die Elemen¬ 
tarmoduln in sich abgeschlossene Funktionsteile bilden (bei Steuernetzentwurf zu be¬ 
achten). 

Im folgenden wird aus den unterschiedlichen Hierarchieebenen je eine Funktions¬ 
gruppe vorgestellt, wobei in diesen Entwürfen die Plätze und Transitionen nicht durch¬ 
numeriert, sondern mit mnemotechnischen Bezeichnungen versehen sind. Für Transitio¬ 
nen ohne angegebene Schaltbedingung wird für diese der logische Wert 1 vereinbart. 

Steuerungstechnische Funktionsgruppen 

FG 1 Not-Aus 

Diese Funktionsgruppe (FG) erfaßt alle zu einem Not-Aus führenden Signale (RES 7) 
und erlaubt in Abhängigkeit davon das Einschalten der Steuerung. Die eingeschaltete 
Steuerung ist Voraussetzung für die Funktion aller weiteren Funktionsteile (Bild 5.20). 



Bild 5.20. Erfassung von Not-Aus-Situationen 

a) Programmablaufgraph; b) Steuernetz 


Konstruktiv-technologische Funktionsgruppen 

• Koordinator Steuerwerk (STW) 

Das Steuerwerk koordiniert die Reihenfolge der zur WZM-Beschickung notwendigen 
Bewegungen und wählt in Auswertung der Markierung von Subkoordinatorplätzen den 
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geforderten Zyklus aus (Bild 5.21). Es ist als eine Folge von Zuständen (Plätzen Ml bis 
MIO) realisiert, die Elementar- und Teilmoduln aktivieren und nach erfolgter Aktivität 
(Rückkoppelsignal) weiterschalten. Die Plätze Ml bis MIO sind einerseits notwendig zur 
Unterscheidung gleicher Aktivitäten (z. B. Schwenken auf C2) bei Nutzung der gleichen 
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Bild 5.21 

Struktur des Koordinators 

a) detailliertes Steuernetz 

b) vergröbertes Steuernetz 


Koppelplätze und andererseits günstig zur Erkennung des Fortschritts in der Abarbei¬ 
tung der Beschickungstechnologie. 

In einer Grobdarstellung wurden unter Anwendung von Umformungsregeln die 
Aktionstransitionen und deren Koppelplätze zu Plätzen mit der Bezeichnung der je¬ 
weiligen Aktion zusammengefaßt. Damit konnte eine übersichtliche, aber wenig detail¬ 
lierte Darstellung geschaffen werden. Zu erwähnen ist, daß bei einem Not-Aus-Signal 
(Steuerung AUS) die Anfangsmarkierung des Koordinators eingenommen wird. 

• Subkoordinatoren 

Die Funktionsgruppen dieser Ebene dienen der Auswahl verschiedener Wege im Steuer¬ 
werk bzw. der Auswahl von Koppelsignalen, die das Steuerwerk aussendet bzw. emp¬ 
fängt. Da diese Funktionsgruppen aus speziellen technologischen Forderungen des 
Steuerungsanwenders resultieren und mittels einfacher PAG bzw. Steuernetze ohne Paral¬ 
lelität erzeugt werden können, wird an dieser Stelle auf eine detaillierte Darstellung ver¬ 
zichtet. 

• Teilmoduln 

Bei der Realisierung der TM (technologische Teilmoduln) mittels Netze können die Ein¬ 
koppelsignale folgender Module zum Entaktivieren des jeweiligen genutzt werden. Zum 
Abschluß der Werkstückhandhabung (Endezustand des Koordinators) wird dann ein für 
alle TM gemeinsames Auskoppelsignal (AKOP TM) gebildet, das den jeweiligen Modul 
entaktiviert. Dieses Koppelprinzip ist im Bild 5.19b dargestellt. 
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Auf der Hierarchieebene der Teilmoduln organisiert die FG 1/1 Entnahme Rohteil aus 
Speicher folgenden Bewegungsablauf: 

1. Z-Position der Speicherebene (zusammen mit FG 19/1,2 Ebenenzähler), 

2. A"-Position des Speichers (zusammen mit FG 22 Speicherauswahl), 

3. Greifer schließen, 

4. Aushub AZ (Wert K19Z), 

5. A"-Achse in hintere Endlage verfahren (Wert KlOX), 

6. Z-Achse in obere Endlage verfahren (Wert K20Z), dabei Aushub aus (Bild 5.19 a). 

Die Funktion kann durch vier parallele Zweige eines Netzes realisiert werden 
(Bild 5.22b), wobei von den Plätzen aus die entsprechenden z- und x-Werte aufgerufen 
werden. In diese FG ist der Betriebszustand STOP (keine weitere Bewegung bis zur Auf¬ 
hebung von STOP) eingearbeitet. Die Plätze RI Al, R1A2, RI A3 bedeuten den sog. 
Ruhezustand der einzelnen Aktionen. 

• Elementarmoduln 

Zur Erläuterung von Elementarmoduln wird auf den Bewegungsmodul FG 15/1 Roh¬ 
teilgreifer (GR) eingegangen (Bild 5.23). Diese FG hat die Betriebsarten Automatik mit 
den Koppelbedingungen 

- EKOP2 Greifer öffnen 

- RKOP2 Greifer ist auf 

- AKOP2 Greifer schließen 

- RGRZ Greifer ist geschlossen 

und den Handbetrieb bei Abfrage der Taster 

- S25 Greifer öffnen 

- S61 Greifer schließen 

zu enthalten. 

Als Grundstellung ist der geschlossene Greifer zu realisieren. Zur Kontrolle von er¬ 
folgten Greiferbewegungen wird neben dem Druckmelder S51 ein Zeitbaustein (tq) aus¬ 
gewertet. Diese FG hat auch zu überwachen, ob ein Teil gegriffen wurde (Melder BGR3). 
Während dazu bei der PAG-Methode ein zusätzlicher PAG (KEINT) geschaffen wer¬ 
den müßte, ist diese Kontrolle im Steuernetz mit enthalten. Im Normalfall wird der 
Greifer durch Betätigung des Magnets YGR geöffnet und geht aus dem Zustand GRZ 
(GR zu) über DGR (Druck auf GR) in GRA (GR auf) über. Zum Schließen wird der 
Magnet YGR geschlossen; das Netz geht in GRS (GR schließen) über. Wird im Auto¬ 
matikbetrieb bei Markierung dieses Platzes der Melder BGR3 betätigt, so werden die 
Plätze KEIN T (kein Teil gegriffen) und DGR eingenommen, d.h., der Greifer wird wie¬ 
der geöffnet. Aus der Markierung GRA und KEINT kann man den Greifer nur wieder 
schließen durch Betätigen der Starttaste (S6) im Automatikbetrieb oder durch Übergang 
zum Handbetrieb. 

In der dem funktionellen Entwurf folgenden Phase des strukturellen Entwurfs muß 
noch die Ausgangslogik geschaffen werden. Diese stellt die Beziehungen der Steuerungs¬ 
zustände zu den Ausgangssignalen her. Dabei ist zu beachten, daß die Ausgangssignale 
aus 

- Zuständen (Plätzen) eines PAG (Netzes), 

- Zuständen (Plätzen) mehrerer PAG (Netze), 

- Zuständen (Plätzen) und Eingangssignalen 


resultieren können. 



Initiator Z-Achse 
oben (BZ2) ^ 





Rohteitqreifer mit Initiator 


(B6R3) 


Bild 5.22 

Entwurf des Teilmoduls FG Ijl: 
Entnahme des Rohteils aus dem 
Speicher 

a) Skizze des Bewegungsablaufs 

b) Steuemetz für den Bewegungsablauf 
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5.4.3. Entwurf mit AblaufkontroUnetzen 


Das Beschreibungsmittel AKN impliziert eine taskorientierte Herangehensweise, d.h., 
eine Gesamtaufgabe muß zunächst funktionell in Teilaufgaben zerlegt werden, die zwar 
untereinander parallel, selbst aber nur rein sequentiell gestaltet sein dürfen. Diese Teil¬ 
funktionen (Rechenprozesse, Tasks) erhält man zweckmäßigerweise durch Dekomposi¬ 
tion, wobei mit Hierarchie und Datenrelationen gearbeitet werden sollte. Sind die ein¬ 
zelnen Task funktionell Umrissen, können sie einzeln in zwei Ebenen entworfen werden. 



Bild 5.24 

Entwurfshierarchie bei 
Anwendung von AkN 




Alfernative 



Sequenz 


d.h. in der Ebene der Koordinierungssteuerung als AKN und in der Ebene der Aktions¬ 
steuerung als sequentielle Taskstücke (Aktionen) und Interruptroutinen (Bild 5.24). Der 
funktionelle Inhalt der Aktionen wird aus dem Datenfluß heraus fixiert, indem man 
synchronisationsfreie Abschnitte eines Task (d.h. ohne Steuer- oder datenflußmäßige 
Verkopplung zu anderen Task) zu separaten (Aktions-)Prozeduren deklariert. Die sequen¬ 
tielle Aneinanderreihung dieser Prozeduren, d.h. unter Verwendung der sequentiellen 
Ablaufkontrollstrukturen Sequenz, Alternative und Schleife (Bild 5.25), ergibt wieder den 
ursprünglichen Task. Zwischen den einzelnen Prozeduren - und nur dort - findet die 
Intertaskkommunikation statt, die somit vollständig im AKN beschreibbar ist. Neben 
diesem Vorteil der eindeutigen Trennung von Steuer- und Operationsteil und der damit 
gegebenen Möglichkeit des getrennten Entwurfs mit völlig anderen (angepaßten) Be¬ 
schreibungsmitteln bietet diese Methodologie auch eine gute Basis für die Aufgaben- 


12 Industrierobotersteuerung 



178 


5 . Aktionssteuerung 


Verteilung in einem Bearbeitungskollektiv. Dabei sind bei der Konzeption der Prozedu¬ 
ren und Interruptroutinen neben fest definierten Ein- und Austrittsstellen folgende 
Schnittstellen bezüglich der Koordinierungssteuerung festzulegen : 

- Unterbrechbarkeit 

ACTION unterbrechbare Prozedur 
PROCESS nichtunterbrechbare Prozedur 
für ACTION 

• maximale Stapeltiefe (für die Definition eines eigenen Stack) 

• Registerrettungsmodus. 

- Parameterübergabe 

Wird in der Prozedur eine für die Koordinierungssteuerung relevante Information er¬ 
zeugt, so wird diese als globale Variable (s. Zuweisung im Bild 5.25) behandelt, da ja 
im AKN Ausdrücke über globale Variable als zusätzliche Schaltbedingung an die 
Transitionen geschrieben werden können, oder es besteht die Möglichkeit der Mar¬ 
kierung bestimmter Stellen (Typ TIMED, INPUT), was z.B. der Erfassung externer 
Ereignisse über IR dient. 

Das Beschreibungsmittel für die Prozeduren und Interruptroutinen ist aus der Menge 
der Mittel für die sequentielle Programierung frei auswählbar und soll hier nicht Gegen¬ 
stand weiterer Betrachtungen sein. 


7 



a/ ei pi 


Steuerunq 

“PT 

w/ si 


Bild 5.26 
Transportbeispiel 

Ki Kreuzungspunkte; Wi Weichen; 

Si Stopstellen Signale; ai TE-Annäherung 
aus Richtung /; ei TE-Entfernung in 
Richtung /; pi Richtungspuffer i voll, wi 
Weichenstellsignale (Richtung Ol si Frei¬ 
gabesignale (Richtung i) 


Das gesamte Entwurfsvorgehen mit den Ablaufkontrollnetzen soll im folgenden an 
einem komplexeren Beispiel verdeutlicht werden. Bild 5.26 zeigt einen Ausschnitt einer 
Transportsteuerung, bei der Transporteinheiten (Lastgehänge) kollisionsfrei über die ab¬ 
gebildete 3-Weg-Kreuzung zu leiten sind. Jede Transporteinheit (TE) besitzt eine Ken¬ 
nung, aus der die gewünschte Zielrichtung durch die Steuerung ermittelbar ist, sobald 
sich die TE innerhalb der den Stopstellen 5”, vorgelagerten Pufferstrecken befindet. Be¬ 
fährt eine TE einen solchen Abschnitt, wird die Steuerung mit dem Annäherungssignal 
beaufschlagt. Das Verlassen der Kreuzung wird über Entfernungssignale gemeldet, die 
dann aktiv werden, wenn die Kreuzungspunkte (i = 1 bis 3) von der TE passiert 
wurden. 

Zusätzliche Forderungen an die Steuerung sind: 

a) Realisierung eines maximalen Durchsatzes; 

b) rechts abbiegende TE haben Vorrecht vor links abbiegenden; 

c) „First come - first serve“-Modus, d.h., keine Richtung ist gegenüber einer anderen 
priorisiert. 
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Eine erste Dekomposition der Aufgabenstellung ergibt drei, zunächst als parallel ab¬ 
arbeitbare angenommene Teilfunktionen, die für jede Richtung die Steuerung der an- 
kommenden TE übernehmen. Bild 5.27 zeigt den ersten Grobentwurf des Gesamtsystems 
und Bild 5.28 die erste Verfeinerungsstufe einer Teilfunktion. Die Verfeinerung des 
Task 1 zeigt bereits dessen vollen Funktionsinhalt, der hier in einem Schritt und ohne 
zusätzliche Arbeiten in einem Spezifikationsteil erzeugt wurde. 


Qj Sj 



Bild 5.27 

Funktioneller Grobentwurf des Beispiels 


Bei komplexeren Aufgaben erfordert die Dekomposition und funktionelle Verfeinerung 
wesentlich mehr Aufwand und eine sorgfältige Systematik. Es bieten sich u. a. die Schritte 

a) Objektmodellierung (z.B. auch mit Netz), 

b) Hierarchieentwurf, 

c) Datenflußentwurf 

an (s. dazu [5.10]). 

Bild 5.28 zeigt auch bereits die in den vorangegangenen Abschnitten erläuterte 
2-Ebenen-Struktur, d.h., Verkopplungen mit der Prozeßebene sind nur über die Proze¬ 
duren und Interruptroutinen vorhanden. Der (funktionelle) Umfang der einzelnen Proze¬ 
duren wird durch die externe Signaleinkopplung und die Verzweigungsstruktur anhand 



Interruptroutine: Annäherung einer TE 
aus Richtung 1 

INPUT-Sielte (Pufferstrecke) 

Prozedur: Identifikation der Zieirichtung 
Zi (globale Variable ):=Zie(richtung 


Prozeduren: Stellen der Weiche W1 
und Freigabe des Stoppunktes S7 
über Ausgabe Signal Sj 


Warfen auf Entfernungsmeldung 


IN PUT - Stellen 

Interrupfroutinen: Entfernung einer 
TE in Richtung 2f3) 


Bild 5.28. Verfeinerung einer sequentiellen Teilfunktion 
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der globalen Variable ZI bestimmt. Die Art und Weise der Realisierung der funktionellen 
Inhalte der Prozeduren ist zu diesem Zeitpunkt noch völlig ohne Belang. 

In einem zweiten Schritt müssen nun die notwendigen Synchronisationsbeziehungen 
der Tasks untersucht und entworfen werden. Dies bedeutet konkret, daß die a priori an¬ 
genommene Parallelarbeit (Nebenläufigkeit) der drei Teilkomponenten nun gewissen 
aufgabenspezifischen Einschränkungen unterworfen werden muß. Auch für diesen Schritt 
ist bei komplizierten Strukturen ein Modell des Steuerungsobjekts in Form eines Netzes 
sehr nützlich, während sich für das angegebene Beispiel die parallel ausführbaren Aktions¬ 
folgen relativ leicht überschauen lassen. Man erkennt, daß alle links abbiegenden TE 
untereinander und die Links-Rechts-Paare (1/3), (2/1), und (3/2) die Kreuzung nur 
exklusiv benutzen dürfen, während alle rechts abbiegenden TE untereinander sowie die 
übrigen Links-Rechts-Paare die Kreuzung parallel passieren können. Eine solche Unter¬ 
suchung ist nicht nur bezüglich der Forderung nach maximalem Durchsatz wichtig, son¬ 
dern gibt auch die Basis für die Darstellung einer kausalen, d. h. zeitinvarianten Steuerung. 



(G) 


cross- 
mufex 


Die im Bild 5.29 gezeigte einfachste Synchronisationsvariante der Exklusivität der ge¬ 
samten Kreuzung für jeden einzelnen Task widerspricht demnach nicht nur der Forde¬ 
rung a, sondern verdeckt auch die tatsächlichen kausalen Zusammenhänge. Die un¬ 
zweckmäßige Vergröberung entsteht offensichtlich durch die Beschreibung der gesamten 
Kreuzung als eine einzige unteilbare Ressource (Stelle cross-mutex) im AKN. Eine 
mögliche Verfeinerung wäre die Zuordnung von bestimmten Kreuzungsteilen zu unter¬ 
schiedlichen Ressourcen. Dafür bieten sich die vier Kreuzungspunkte Kq bis K 4 . geradezu 
an. Eine in Richtung i rechts abbiegende TE benötigt dann jeweils eine Ressource und 
die links abbiegenden zusätzlich zu K, noch die Ressource . Die Realisierung im AKN 
eines Tasks ergibt sich durch die Zunahme der jeweils notwendigen Ressourcen in Form 
von markierten Stellen. Dieser zweite Verfeinerungsschritt ist noch nicht die endgültige 
Lösung, da bezüglich Forderung a noch Reserven vorhanden sind und Forderung b über¬ 
haupt nicht betrachtet wurde. Die genannte Reserve im Durchsatz ergibt sich aus der 
Freigabe der Ressource Kq, die erst gemeinsam mit der zweiten Ressource erfolgt, 
also erst einige Zeit nach ihrer eigentlichen Benutzung. Durch Einfügen eines zusätzlichen 
Signals und einer weiteren Transition im AKN (Bild 5.30) ist das Problem lösbar. 

Forderung b ist nur relevant, bei den bereits weiter oben angeführten zueinander 
exklusiven Links-Rechts-Paaren, da nur hier eine Konfliktsituation zwischen zwei unter¬ 
schiedlich abbiegenden Transporteinheiten auftreten kann. Dieser Konflikt kann auch 
dann noch eintreten, wenn man das absolut gleichzeitige Eintreffen zweier TE vernach¬ 
lässigt, da zugelassen ist, daß in den Pufferstrecken mehrere TE stehen können. So kann 
es durchaus zu einem Fall kommen, bei dem die Stelle /12 (Bild 5.30) im Task 1 und die 
entsprechende Stelle (^ 2 ) im Task 3 markiert sind und außerdem ZI = Z3 = 2 gilt. Die 
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Konfliktlösung mittels der PufFerstellen BRl bis 3 (Nulltest über Inhibitorkante) ist im 
Bild 5.30 bereits enthalten. Erfolgt jetzt während der aufeinanderfolgenden Weiter¬ 
leitung nach links mehrerer (im Puffer stehender) TE aus Richtung 1 eine Anmeldung 
einer TE aus Richtung 3 nach rechts, so wird die Abarbeitung der Linksabbieger über 
BR3 gestoppt und zunächst der Rechtsabbieger weitergeleitet. Voraussetzung bei dieser 
Herangehensweise ist allerdings, daß für die als parallel angenommenen Tasks auch tat¬ 
sächlich je ein Aktionsträger (Rechner) zur Verfügung steht (Simultanarbeit). Eine solche 



implementierungsbezogene Frage muß zum Entwurfsanfang offengehalten werden, wird 
dann aber in einer bestimmten Stufe des Entwurfs endgültig geklärt (z.B. bei Prioritäts¬ 
fragen). Die Lösung unter Berücksichtigung der zusätzlichen Forderungen b und c kann 
demnach für eine Multitaskvariante anders geartet sein als bei Simultanarbeit, was in der 
zusätzlichen Ressource Rechner begründet ist. Betrachtet man zunächst die Forderung c, 
so ist zu ihrer Erfüllung eine „faire“ Vergabe von Prioritäten an die einzelnen Tasks zu 
realisieren (rollender Vergabemodus). Um das Netzmodell nicht unnötig zu verkompli- 
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zieren, wird diese Information in der Sprachnotation des Netzes angegeben. Außerdem 
ist es jetzt notwendig, auch die Unterbrechbarkeit der einzelnen Task zu betrachten, da 
ohne diese ein Multitasking nicht möglich ist. Jeder Task besitzt zwei Möglichkeiten der 
Unterbrechbarkeit: 

a) innerhalb seiner Prozeduren, was anwenderspezifisch festgelegt werden kann durch 
die Deklaration der Prozedur als PROCESS (nicht unterbrechbar) oder ACTION 
(unterbrechbar), und 

b) innerhalb des „Netz-Steuerprogramms“, d.h. also, wenn sich die „Taskmarke“ auf einer 
internen Stelle befindet. 

Damit ist allerdings Forderung b immer noch nicht erfüllt, da es jetzt in dem oben an¬ 
gegebenen Beispielfall zwar zu einer Unterbrechung durch die TE-Anmeldung aus Rich¬ 
tung 3 kommt (Markierung von AN3), was aber nicht zwangsläufig auch zu einer sofor¬ 
tigen Ausführung des Task 3 führen muß, da durch die rollende Priorität gerade Task 1 
bevorteilt sein kann. Das gewünschte Verhalten kann durch das Einrichten einer zweiten, 
höher priorisierten Ebene erreicht werden, in der die Identifikation der ankommendenTE 
vorgenommen wird. Dadurch zerfällt die bisherige Taskstruktur in zwei Teile. Bild 5.31 



Bild 5.31. Taskstruktur einer Teilfunktion bei quasiparallel arbeitenden Aktionsträgern 


zeigt die neue Netzstruktur, wobei der ehemalige Task 1 durch die Task IDENTl und 
AUSl ersetzt wurde. Jetzt wird bei Annäherung einer rechts abbiegenden TE aus Rich¬ 
tung 3 nicht nur AN3 markiert, sondern durch die immer höhere Priorität von IDENT3 
gegenüber AUSl (verschiedene Ebenen) kommt es zur Identifikation der TE und damit 
zur Markierung von Stelle BR3, vorausgesetzt natürlich, daß die PufFerstrecke 3 leer war. 
Damit ist, unabhängig vom momentanen Stand der Prioritäten von AUSl und AUS3, die 
Prozedur AUSIL (und damit der Task AUSl) blockiert, und es kann AUS3 abgearbeitet 
werden. Die von den Pufferstellen BRi bzw. BLi ausgehenden Inhibitorkanten (Null¬ 
test) bewirken das Sperren der Identifikation, wenn eine TE mit anderem Richtungs¬ 
wunsch als die in der PufFerstrecke schon vorhandenen eintrifFt. 
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Über die angegebene Aufgabenstellung hinaus lassen sich nun noch Erweiterungen 
realisieren, die sich im Laufe des Entwurfsprozesses ergeben. So erscheint es beispiels¬ 
weise sinnvoll, die Pufferstrecken durch zusätzliche Signale zu überwachen, um ein un¬ 
normales „Ansammeln“ von TE zu vermeiden. Eine solche Situation kann z.B. ein- 
treten, wenn durch ungünstiges wechselseitiges Befahren der Kreuzung von zwei Rich¬ 
tungen die dritte Richtung über einen längeren Zeitraum keine Konzession erhält, weil 
immer eine notwendige Ressource fehlt (sog. Livelock). Durch ein solches Signal Pi soll 
über eine zusätzliche, entsprechend hoch priorisierte Task diese Richtung für eine ge- 



ö 6 ö 
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Bild 5.32. Task zur Verhinderung von Livelocks 
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wisse Zeit die Kreuzung allein benutzen dürfen. Die Realisierung im AKN wird im 
Bild 5.32 gezeigt. Dabei bedeutet das Oval mit der ausgehenden Blitzsymbolkante in 
einigen Transitionen die Verwendung eines Systemmakros (DIRS ^/elayed Interrupt 
request 5ubroutine) zur verzögerten Markierung einer Ausgangsstelle, d.h. in dem kon¬ 
kreten Fall der Stellen Zij. Die Indizes i, j stehen dabei für die beiden Richtungen, die 
über die Teststellen STi bzw. STj für eine gewisse Zeit gesperrt werden. 

Eine letzte Ergänzung sei dem Havariefall einer TE innerhalb des Kreuzungsbereichs 
gewidmet. Tritt eine solche Situation ein, soll eine hier nicht näher betrachtete Fehler¬ 
reaktion (Meldung) in Form von Prozeduren SEKi abgearbeitet werden. Die Über¬ 
führung in den normalen Betriebszustand erfolge dabei über Handstellsignale h^. Eine 
entsprechende Netzkonstruktion zur Überwachung im Task AUSl wird in Bild 5.33 ge¬ 
zeigt. Dabei wird eine zeitliche Überwachung realisiert, d.h., wenn nach einer bestimmten 
Verzögerungszeit die Entfernungsmeldung nicht erfolgt, werden die Stellen ZRi bzw. 
ZLi über die bereits erwähnten Systemmakros (DIRS) markiert, und die Fehlerprozedur 
erhält Konzession. Trifft das Signal vor Ablauf der Verzögerungszeit ein, so wird die 
geplante Markierung über ein weiteres Systemmakro (DIRSO) zurückgenommen. 

Eine besondere Fehlermaßnahme ist nicht notwendig, da die beteiligten Ressourcen K, 
im Havariefall nicht freigegeben werden. Die Implementierung des Entwurfsmodells mit 
Hilfe einer speziell dafür geschaffenen Entwicklungssoftware wird im Abschnitt 5.5.4. 
beschrieben. 


5.5. Struktureller und technischer Entwurf 

5.5.1. Emüttlung der logischen Gleichungen aus dem PAG 

Die Realisierung der mit den PAG entworfenen Steuerungsfunktion erfolgt als endlicher 
binärer Automat. Dadurch ergeben sich drei wesentliche Arbeitsschritte: 

- Festlegung der Steuerungszustände im PAG; 

- Festlegung der Kodierung der Steuerungszustände; 

- Erfassung des Inhalts der PAG mit Hilfe Boolescher Gleichungen: 

Zustandsüberführungen, 

Ausgangslogik. 

Aus der Vielzahl der Lösungsmöglichkeiten wird in [5.13] ein auf theoretischen Er¬ 
kenntnissen und praktischen Erfordernissen und Erfahrungen beruhender Algorithmus 
ausführlich angegeben: 

- Zuordnung der Steuerungszustände Z, zu den Aktivitätenkästchen Yj des PAG (da¬ 
durch Unterscheidung gleicher Aktivitäten im PAG). 

- Mit Ausnahme des Anfangs- oder Ruhezustands Zq eines PAG sind die Zustände 
l-aus-«-kodiert (je Zustand ein Flipflop). 

- Der Anfangs- oder Ruhezustand Zq eines PAG wird unter dem Gesichtspunkt der 
Initialisierung beim elektrischen Zuschalten der Steuerung an das Netz eingenommen, 
wenn alle anderen Zustände des PAG nicht markiert (gesetzt) sind. 

- Das Verfahren der Bestimmung der Booleschen Gleichungen ist in einer ersten Variante 
auf ein Betriebssystem der Steuerungstechnik zugeschnitten, das den Programmspeicher¬ 
inhalt zyklisch vollständig abarbeitet (polling). Die Möglichkeit der Programmierung 
von Sprüngen in Abhängigkeit logischer Bedingungen (Steuerungssystem 600) kann 
dabei intuitiv genutzt werden. 
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In einer zweiten Variante der Bestimmung Boolescher Gleichungen nutzt man die 
Möglichkeit von Programmsprüngen in Steuerungen der Generation 600 gezielt zur 
schnelleren Abarbeitung des gesamten Gleichungssystems (Faktor 2 bis 3), 

Verfahren der Zustandsgleichungen 

Der inhaltliche Grundgedanke liegt darin, je Zustand z^eine Gleichung zu schreiben. Da 
sie das Speicherverhalten mit realisieren muß, hat sie drei Bestandteile: 


Zf. = Setzterm + Halten x Rücksetzen 


Zf = Wzjhji 

+ Zl (A Zfc) /2io 

für 

Vf ^ 0 

(5.10) 

y/ ^ i 

VA: # /, 0 




Zq = t\Zi 


für 

^05 

(5.11) 


V/ # 0 

j Index der Vorzustände zum Zustand z, 
k Index der Folgezustände zum Zustand Zi 

hji logische Bedingung für den Zustandsübergang zj Zj (entspricht dem Weg im PAG von zj nach Zj). 

Diese Gleichungsform wird aus Gründen der sicheren Vermeidung von Fehlern infolge 
der seriellen Abarbeitung des Gleichungssystems und eines geringen Programmspeicher¬ 
platzbedarfs zur Erfassung des Inhalts von PAG empfohlen, die selbständig (nicht ge¬ 
koppelt mit anderen Graphen) arbeiten und i ^ 4 Zustände besitzen. 

Spezialfall für / = 2 (hier gilt Zq = z7): 

Zl — -f" ^lh\Q 

oder (5.12) 

Zl = ^1^01 ”1” 

Modifiziertes Verfahren der Zustandsgleichungen 

Diese Modifikation ist universell anwendbar. Gegenüber dem ursprünglichen Verfahren 
wird dieser Effekt dadurch erzielt, daß die Setzterme der Zustände als selbständige 
Zwischensignale (Adressen temporärer Merker der Steuerungstechnik) berechnet und 
danach erst die Zustandsgleichungen bestimmt werden. 

Der Einsatz empfiehlt sich für 

selbständige PAG mit / ^ 4 Zuständen, 
alle anderen PAG mit i > 2 Zuständen. 

Reihenfolge der Gleichungen: 

1. Setzterme 

Si = ^Zjhji V/ (5.13) 

V/ 7^ i 

2. Rücksetzterm (einer je PAG) 


r = y Si 


V« 


(5.14) 
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3. Zustandsgleichungen 

z,; = + z/ V/ ^ 0 (5.15) 

Zq = y Fi V/ ^ 0 

4. Ausgangslogik. 

Hervorzuheben ist, daß nur noch die Setzterme und die Ausgangslogik aufgaben¬ 
spezifisch sind. Der Rest könnte formal ergänzt werden. Verwiesen sei auch auf die 
Möglichkeit, die Gleichung für Zq (Ruhezustand) zu eliminieren, indem an den erforder¬ 
lichen Stellen die Gleichung für Zq explizit eingesetzt wird (für den Zustand Zq wird dann 

kein Signal mehr gebildet). 


5.5.2. Ermittlung der logischen Gleichungen aus dem Steuemetz 

Das beschriebene Notierungsverfahren für Programmablaufgraphen (Zustandsgleichung) 
wurde zur Steuernetzumsetzung folgendermaßen erweitert: 

1. Bildung aller Setz-Rücksetz-Terme eines Netzes 

Alle Transitionen mit den zugehörigen Schaltbedingungen und Vorplätzen werden 
als Terme (Merker) erfaßt: 

ti=fiA Sj 

fj Schaltbedingung der Transition Tj 
si Vorplätze von der Transition Tj. 

2. Bildung der Zustandsgleichung 

Für jeden Platz des Netzes werden die Vor- und Folgetransitionen erfaßt und in eine 
Boolesche Gleichung eingearbeitet: 

Platz = V Setzterme + Platz x A Rücksetzterme 

■yk = V ts -I- 5k X A tr', 

k Index des entsprechenden Platzes 
s Index der Vortransitionen des Platzes 
r Index der Folgetransitionen des Platzes. 

3. Anfangsmarkierung 

In Abhängigkeit von der eingesetzten Steuerung kann die Anfangsmarkierung unter¬ 
schiedlich realisiert werden. In speicherprogrammierbaren Steuerungen mit ausschließ¬ 
lich Boolescher Logik kann die Anfangsmarkierung durch Erweiterung der Zustands¬ 
gleichungen der im Anfangszustand markierten Plätze realisiert werden: 

Sj = y ts + in + Sj X /\ 'iüj e Wo; 

m Merker für die Anfangsmarkierung, der beim erstmaligen Programmdurchlauf den logischen Wert 0 
besitzt und erst am Programmende auf den Wert I zu setzen ist. 

Dieses auf dem Zustandsbegriff (Plätze = Zuständen) basierende Verfahren kann bei der 
Notation von Netzen ohne Parallelarbeit durch die für Programmablaufgraphen ent¬ 
wickelten Verfahren ersetzt werden. 
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5.5.3. Implementierung des AKN-Entwurfs mit dem Softwareentwurfssystem 
PSI 1520 

An die im vorangegangenen Kapitel skizzierte Entwurfsphase eines AKN schließen sich 
je eine Analyse-, Test- und Implementierungsphase an, die durch das System PSI 1520 
(Petri-Netz-Simulation und Implementierung für Zielrechner der Generation Kl520) 
maximal unterstützt werden. Das System wurde zur Softwareerstellung für kleinere bis 
mittlere Automatisierungsvorhaben entwickelt, die sich insbesondere durch kritisches 
Echtzeitverhalten, hohen Parallelitätsgrad und starke Koppelbeziehungen zwischen ein¬ 
zelnen Teilaufgaben auszeichnen und somit auch günstig für die softwaremäßige Reali¬ 
sierung der Koordinierungssteuerung von Industrierobotern einsetzbar ist. Das System 
arbeitet mit dem Beschreibungsmittel AKN und benötigt als gerätetechnische Grundlage 
einen Bürocomputer BC A5120 mit dem Betriebssystem UDOS. 

In einem ersten Schritt ist eine AKN-gerechte Eingabeform für das Entwurfssystem 
PSI 1520 zu erstellen. Dies geschieht entweder in einer Sprachversion oder in einer ge¬ 
mischt grafisch-alphanumerischen Version. Unabhängig von der Eingabeversion gibt es 
immer einen Deklarationsteil, der die im Netz bezeichneten Stellen als Variable bestimm¬ 
ten Typs definiert. Es wird dabei unterschieden zwischen taskinternen Stellen (INTERNT), 
die nur der sequentiellen Verkopplung der Prozeduren im Task dienen; sicheren Inter¬ 
taskkoppelstellen (SAVE); beschränkten Intertaskkoppelstellen (BOUND), die für einen 
Systemeinsprung (CALLOS) mit angebbarer Zielebenenpriorität generierbar sind sowie 
den Nulltest ermöglichen; externen Intertaskkoppelstellen (EXTERN), die der Kommu¬ 
nikation zwischen Task verschiedener Rechner dienen, und Stellen mit Kontakt zur 
Prozeßperipherie, die sich in zeitbewertete Stellen (TIMED) und Interrupteingabestellen 
(INPUT) aufteilen. Außer den Peripheriestellen können hier alle anderen auch mit einer 
Anfangsmarkierung versehen werden. 

Anschließend werden alle Tasks ebenenweise notiert oder grafisch auf den Bildschirm 
„gezeichnet“. Dabei kann für jede Ebene unter dem Schlüsselwort PMODE eine Priori¬ 
tätsverteilungsstrategie aus den Möglichkeiten FIX (feste Prioritätsverteilung), VAR 
(feste, aber dynamisch änderbare Prioritätsverteilung) und ROLL (rollende Prioritäts¬ 
verteilung) ausgewählt werden. Die der Ebene zugewiesene eigene Priorität entspricht 
einer festen Prioritätsverteilung unter allen angegebenen Ebenen. Die Tasks (TASK) 
werden nach einer möglichen Angabe ihrer Anfangspriorität in der jeweiligen Ebene 
transitionsweise (TRANS) notiert („gezeichnet“), wobei in der grafisfchen Variante nur 
ein drei Zeichen langer Name vergeben wird, über den dann in einer alphanumerischen 
Eingabezeile die weiteren Eigenschaften (ACTION, PROCESS usw., s. oben) definiert 
werden. In der Sprachversion müssen dann zusätzlich alle Eingangs- (IN) und Ausgangs¬ 
stellen (OUT) sowie evtl, vorhandene Inhibitoreingänge (INHIB) oder Formeln (COND) 
als zusätzliche Schaltbedingung angegeben werden. 

Bild 5.34 zeigt Ausschnitte aus der Sprachversion für das zuletzt angegebene Netz¬ 
modell der Bilder 5.31, 5.32 und 5.33. Mit der Fertigstellung des Entwurfs der Koordi¬ 
nierungssteuerung in Form eines entsprechend beschrifteten Ablaufkontrollnetzes kann 
mit dem Entwurf der Aktionssteuerung (Prozeduren, Interruptroutinen) begonnen wer¬ 
den. Auch dafür bietet das System PSI in Form des Programmpakets PSI.PPC (PSI- 
procedure-precompiler) eine gute Unterstützung. Es besteht aber auch die Möglichkeit, 
die entworfene Koordinierungssteuerung zu analysieren und mit abzuschätzenden Proze¬ 
durlaufzeiten auf seine Echtzeitfähigkeit auszutesten, ohne eine einzige Prozedurzeile 
programmieren zu müssen. 
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LEVEL AUSGABE PRIORITY: = 3 PMODE = ROLL; 

TASK AUSl ; 

(* AUSGABE-PROZEDUREN *) 

(IN 113, BRl, K3 OUT Fll) 

ACTION AUSIR STACK: = 8 PUSH = COMPLETE; 

(IN 113, BLl, KO, K2 OUT 115 INHIB BR3) 

ACTION AUSIL STACK: = 8 PUSH = COMPLETE; 

(* FEHLER-PROZEDUREN *) 

(INI15, ZLl OUT Fll) 

ACTION FEKO STACK: = 6 PUSH = SIMPLE; 

(IN Fl 3, ZLl OUTF14) 

ACTION FEK2 STACK: = 6 PUSH = SIMPLE; 

(INF11,ZR1 OUTF12) 

ACTION FEK3 STACK: = 6 PUSH = SIMPLE; 

(* TIME OUT-UEBERWACHUNG *) 

(IN Fl 1, EN3 OUT 114) PROCESS TI I; 

(INF13, EN2 OUT 116) PROCESS TI 2; 

(* SCHALTTRANSITIONEN *) 

(1NF12, Hl OUT 114); 

(INF14 OUT 113, K3); 

(INF15, ENO OUT KO, Fl 3); 

(INF14, Hl OUTF15); 

(1NF15,116 OUT 113, K2); 

ENDTASK; 

TASK AUS2; ... ENDTASK; 

TASK AUS3; 

(iNF35,136 OUT 133, Kl); 

ENDTASK 

ENDLEVEL. 

NET DREIWEG; 

(* STELLENDEKLARATION *) 

INTERN H: = l, Hl: = l, I13:=l, 121: = !,..., I33: = l 
(* TASK-ANFANGSMARKIERUNG *), 

12,13, 112,114, 115, 116, 122, ..., 136, 

Fll, ..., F15, F21, ..., F35; 

SAVE K0: = 1, Kl: = l, K2: = l, K3: = l (♦ KREUZUNGSPUNKTE *) 

BOUND ST , ST2, ST3, (• TASKSTOP-TEST *) 

BRl, BLl, BR2, BL2, BR3, BL3; 

INPUT ANl, AN2, AN3, (* ANNAEHERUNG *) 

ENO, ENI, EN2, (* ENTFERNUNG *) 

PVl, PV2, PV3, (* PUFFER VOLL ♦) 

Hl, H2, H3 (*HANDSIGNALE *); 

TIMED Z23, Z12, Z13, (* TASKSTOP-ZEIT ♦) 

ZRl, ZLl, ZR2, ZL2, ZR3, ZL3 (* TIME OUT-UEBERWACHUNG *); 

(* EBENENDEFINITIONEN *) 

LEVEL TSTOP PRIORITY: = l PMODE = FIX (* TASKSTOP BEI PUFFER VOLL *); 
TASK TSTOP; 

(* STOPZEIT-PROZESSE *) 


Bild 5.34 
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(IN PVl, II OUT ST3, 12, ST2) PROCESS TI 

(* MARKIERT VERZOEGERT Z23 *); 

(IN PV2, II OUT STl, 13, ST2) PROCESS T2; 

(IN PV3, II OUT STI, 14, ST2) PROCESS T3; 

(* SCHALTTRANSITIONEN *) 

(IN 12, Z23, ST2, ST3 OUT II); 

(IN 13, Z12, STl, ST2 OUT II); 

(IN 14, ZI3, STl, ST3 OUT II);. 

ENDTASK 

ENDLEVEL; 

LEVEL IDENTIFY PRIORITY: = 2 PMODE=ROLL (♦ ZEITIDENTIFIKATION *); 
TASK IDENTl; 

(* ZIELBESTIMMUNG *) 

(INAN1,I11 OUT 112 INHIB STl) 

ACTION ZIELl STACK: = 10 PUSH = SIMPLE; 

(* ENTSCHEIDUNGSTRANSITIONEN ♦) 

(IN 112 OUTIll,BRl INHIB BLl) COND ZI =3; 

(IN 112 OUT 111, BLl INHIB BRl) COND ZI =2; 

ENDTASK; 

TASK IDENT2; ... ENDTASK; 

TASK IDENT3; ... ENDTASK 
ENDLEVEL; 


ßild 5.34. PSI-Sprachversion des Transportbeispiels 


Bei der Analyse wird die Möglichkeit des Netzbeschreibungsmittels ausgenutzt, daß 
bestimmte für die Steuerung relevante Netzeigenschaften analytisch untersucht werden 
können. Herausragendste Eigenschaft ist dabei die sog. Netzlebendigkeit, die für die 
Steuerung garantiert, daß kein Verklemmungszustand durch die Steuerung selbst ver¬ 
ursacht werden kann. Voraussetzung für die Arbeit mit dem Analyseprogrammpaket 
PSI.ANALYSIS ist der vom Netzcompiler PSI.COM aus der PSI-Sprachform übersetzte 
Zwischenkode. Die Sprachversion wird dabei entweder über einen normalen Quell¬ 
texteditor des Trägerentwicklungssystems erstellt, oder, wenn der Entwurf am Bildschirm 
erfolgt, mittels Programmpaket PSI.GRAPHIC erzeugt. Sind die Analyseergebnisse be¬ 
friedigend, erfolgt mit dem Kodegenerator PSI.CG die weitere Verarbeitung des Zwi¬ 
schenkodes. Wird eine Weiterarbeit auf Simulationsbasis gewünscht, erzeugt PSI-CG 
eine Datei NSIM, die aus folgenden Teilstücken besteht: 

• NSB («et 5tructure hlock) - dieses Stück bildet den problemabhängigen Teil des PSI- 
Laufzeitsystems in einer besonders komprimiert aufbereiteten Form der Netztopo¬ 
logie; 

• DSA (Jynamic jtorage allocation) - Arbeitsspeicher des PSI-Laufzeitsystems, enthält 
auch den Stack der Aktionsprozeduren; 

• TSP (time Simulation of procedures) - schafft die Möglichkeit einer variablen zeitlichen 
Simulation aller Aktionen und Prozesse. 

Diese Datei NSIM wird mit dem PSI-Echtzeitkern PSI.RTN (PSI-real-rime-«ucleus) 
und dem Testprogramm PSI.DEBUG im Objektformat gebunden und über PSI.DEBUG 
gestartet. Dieser Debugger bietet in Form von Traceprotokollen einen Überblick über die 
zeitliche Reihenfolge aller Systemereignisse und die Systemauslastung. Dazu arbeitet 
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PSI.DEBUG in zwei Moden: einem Usermode (dann ist das PSI-Laufzeitsystem PSI.RTN 
aktiv) und einem Systemmode, während dessen Aktivzeit die Echtzeituhr gestoppt wird. 
Auf diese Weise sind ähnlich einem Emulationssystem zu beliebigen Zeitpunkten Ein¬ 
griffe in den Ablauf vornehmbar (oder planbar), ohne die Echtzeit zu verfälschen. Vor¬ 
aussetzung einer solchen Arbeitsweise ist allerdings die Identität des Zielprozessors mit 
dem des Entwicklungssystems, oder es müssen spezielle Hardwareemulatoren gebaut wer¬ 
den. PSI.DEBUG bietet u.a. folgende Möglichkeiten: 

- Einstellen und Verändern der Prozedurlaufzeiten, 

- Setzen von Unterbrechungspunkten in Prozeduren, 

- zyklisches und azyklisches (verzögert, stochastisch) Markieren von Peripheriestellen, 

- Einstellen und Verändern der Werte von globalen Variablen, 

- Einstellen und Verändern von Prioritätsverteilungsstrategien und Prioritätsrangfolgen, 

- Ein- und Ausschalten der Tracefunktion, 

- Auflistung der momentan aktuellen Markierungen. 

Für das oben angeführte Beispiel ist ein kurzer Ausschnitt eines Traceprotokolls in 
Tafel 5.2 angegeben, der eine Konfliktsituation mit Lösung „rechts vor links“ der Rich¬ 
tungen 3 und 1 und eine Parallelfahrt (1 links, 2 rechts) zeigt. 


Tafel 5.2. Ausschnitt aus einem Trace-Protokoll 

PSI.DEBUG: TRACE-PROTOKOLL: NET DREIWEG 

CLOCK CYCLE: 100 ms (not printed) 


Time (MIN:SEK:USEK) 

Aktivity 

Name 

Place for comment 

00:00:000 

SYS 


Dyn. Stopzustand 

00:02:104 

I 

Al 

Interrupt ai 

00:02:104 

A 

ZIELl 

Start Proc. ZIELl 

00:02:302 

I 

A3 



00:02:303 

A(R) 

ZIELl 

Restart Proc. ZIELl 

00:02:523 

A 

ZIEL3 

• 

00:02:548 

A 

AUS3R 

j 

i 

00:03:648 

SYS 



, Fahrt (3,2) 

00:07:100 

I 

F3 

▼ 

• 

00:07:101 

Aü 

AUSIL 

i 


00:08:201 

SYS 




00:10:050 

I 

A2 


Fahrt (1,2) 

00:10:050 

A 

ZIEL2 


• 

00:10:270 

A 

AUS2R 


A 

00:11:370 

SYS 



1 Fahrt (2,1) 

00:13:700 

I 

E2 


• 

00:13:701 

SYS 



r 

00:14:200 

1 

El 

• 

00:14:201 

SYS 





Durch eine stochastische Belegung der Anforderungssignale unter einer wählbaren 
Verteilung (Gleich-, Gauß- oder Poisson-Verteilung) lassen sich auch bedientheoretische 
Aussagen bezüglich Reaktionszeiten und Rechnerauslastung treffen. 

Erst nach erfolgter Zeitsimulation und evtl, notwendigen Präzisierungen (iterative 
Schritte) in der Netzstruktur sollte der Entwurf der Aktionssteuerung beginnen. Über 
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die im Debugging gewonnenen Erkenntnisse ist ein genaues Laufzeitmaximum aller Pro¬ 
zeduren sowie deren Arbeit mit den globalen Variablen der Koordinierungsebene vor¬ 
gegeben. Natürlich ist auch ein umgekehrtes Vorgehen, beginnend mit dem Entwurf der 
Prozeduren (z.B. bei Standardprogrammen), denkbar. 

Für die Gestaltung aller Programme in der Aktionssteuerung stehen PSI-System- 
makros zur Verfügung, die durch den Vorübersetzer PSI.PPS so verarbeitet werden, daß 
Assemblerquellprogramme entstehen. Dabei wird gleichzeitig die richtige Benutzung der 
Makros bezüglich des entworfenen Netzes, unter Benutzung der Datei NSB, getestet. 
Liegt noch kein Netz vor, werden bestimmte Randwerte im Dialog abgefragt. 

Tafel 5.3. Systemmakros von PSI 1520 



Name 

Parameter 

Funktion 

1 

STRT 

1 

NAME 

Prozedur beginn für ACTION und PROCESS NAME 

2 

INTR 

- 

Beginn einer Interruptroutine 

3 

AEND 

NAME 

Prozedurende für ACTION NAME 

4 

PEND 

NAME 

Prozedurende für PROCESS NAME 

5 

lEND 

- 

Ende einer IR 

6 

DIRS 

PLN,DEL 

(delayed interrupt sequest subroutine) 

PLN (place name) vom Typ TIMED 

DEL (delag) ganzzahliges Vielfaches vom Grundtakt um DEL 
verzögertes Markieren von Stelle PLN über die PSI.RTN- 
Echtzeituhr (IR:EUHR), wenn DEL = 0 

Austragen einer geplanten Markierung für PLN, wenn DEL = 0 

7 

PINC* 

PLN 

(placemarking increment) PLN vom Typ INPUT 
m(PLN): = m(PLN)-l-I 

8 

PRES* 

PLN 

(placemarking reset) PLN vom Typ INPUT m (PLN): = 0 

9 

PMOD 

LPN.MODE 

(priority modification of level) 

LPN (level priority number) 
r FIX wenn 0 

MODE = < VAR wenn 1 
l ROLL wenn 2 

Prioritätsvergabestrategie von Ebene LNR ergibt sich zu Mode 

10 

VAPA 

LPN,SPOS, 

DPOS 

(variable priority assigment) LPN (wie oben) 

SPOS = (source Position) alte Prioritätsposition 

DPOS = (drain Position) neue Prioritätsposition in LPN 

Task von SPOS wird auf DPOS eingeordnet, dazwischen¬ 
liegende Positionen werden verschoben 

11 

LPIN 

LPN 

(level priority-sheduling initiatization), PLN (w. o.) 
einer Ebene LPN = 0 

Herstellen des PMODE-Initialzustandes 
aller Ebenen LNP = 0 


*) Makros dürfen nur in Interruptroutinen verwendet werden 


Eine Aufstellung der bisherigen Systemmakros gibt Tafel 5.3 an. Werden Prozeduren 
in PLZ-SYS erstellt, so sind die Makros entweder in externen Assemblerprozeduren 
unterzubringen oder werden nach der PLZ-Compilierung in der Assemblerquelltextstufe 
eingefügt. Für das Entwurfsbeispiel sind in den Bildern 5.35 und 5.36 einige Prozeduren 
und Interruptroutinen auszugsweise angegeben. Sind alle Prozeduren und Interrupt¬ 
routinen erstellt und getestet, wird eine Trennung zwischen Programmspeicher- und 
Datenspeicherteilen vorgenommen, die anschließend zweckmäßigerweise zusammengefaßt 
werden, um sie zu zwei Objektdateien für ROM und RAM zu übersetzen. Diese Dateien 
bilden dann das beim Debugging benutzte Teilstück TSP. Für die Realisierung auf einem 
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;TASK TSTOP; 

STRT 
EXTERNAL 
TI DIRS 

ENDP 


;TASK IDENT 1: 

STRT 
EXTERNAL 
ZIELl EI 


LD 

ENDA 

•TASK AUSl: 

STRT 
EXTERNAL 
AUSIR 

; STELLBEFEHL: W1 NACH RECHTS 

EI 

WARTEN 0.5 SEC WEICHENSTELLZEIT 
STOPSTELLE S1: = FREI 

WARTEN 0.5 SEC PASSIERZEIT EINER TE > UNTEILBARE OPERATION 
STOPSTELLE Sl: = BESETZT 


DIRS ZRl 40 ;4 SEC TIME OUT ZEIT 

ENDA 

TI 

STRT 

TU 

EXTERNAL 

ZRl 

TU DIRS 

ZRl 0 ;AUSTRAGEN DER IR-ANMELDUNG VON AUSIR 

ENDP 

TU 

Bild 5.35. Ausschnitte 

aus den Taskprogrammen 

EXTERNAL 

ANl, AN2, AN3, ENO, ENI, EN2, EN3 

SAMIl INTR 

IN 

PORTI 

RRA 

JRC 

A2 

PINC 

ANl 

ENDI 

A2 RRA 

JRC 

A3 

PINC 

AN2 


ENDI 


E2 

RRA 



JRC 

E3 


ENDI 


E3 

PINC 

EN3 


ENDI 



TI 

Z23 

Z23 250 ;250 * 100 MS = 25 SEC VERZOEGERUNG 
TI 


ZIELl 

ZI 

;ERLAUBT INTERRUPT 

IDENTIFIKATION: ERGEBNIS IN <A> 

(ZI), A ;GLOBALE VARIABLE ZI 
ZIELl 


AUSIR 

ZRl 


Bild 5.36. Ausschnitt aus dem Interruptprogramm 
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konkreten Zielsystem ist auch für die Strukturblock- und Arbeitsspeicherdatei (NSB und 
DSA) eine Aufspaltung mittels PSI.CG notwendig, da gegenüber der Testvariante auf 
dem Entwicklungssystem einige zielsystemabhängige Informationen benötigt werden. 
Insbesondere betrifft das die Speicheraufteilung (PROM für NSB und RAM für DSA) 
und die Generierung der Echtzeituhr, für die ein CTC-Baustein mit zwei koppelbaren 
Kanälen (Zeitgeber/Zähler) notwendig ist. Für diesen wird vom Kodegenerator die not¬ 
wendige Information im Dialog zusammengestellt, wobei folgende Daten einzugeben 
sind: 

- CTC-Interruptvektor-Tabelle (Adresse), 

- CTC-Basis-Adresse (Kanal 0), 

- Nummer des Zeitgeberkanals, 

- Nummer des Zählerkanals, 

- EUHR-Grundtakt (als Vielfaches von 10 ms). 


Die weiter notwendige Generierung des Zielsystems (z.B. Initialisieren der Peripherie¬ 
bausteine für externe Interruptsignale bzw. die Prozedur-Ein-/Ausgaben zur Prozeßperi¬ 
pherie) muß vom Anwender selbst vorgenommen werden. Dafür wird vom PSI-Laufzeit- 
system während der Anlaufphase (vor der Uhr-Initialisierung und dem damit verbundenen 
„heißen“ Start des Gesamtsystems) eine Aussprung- und Wiedereinsprungtabelle bereit¬ 
gestellt. In diesem dort einfügbaren Programmstück ist es auch möglich, globale Variable 
zu initialisieren, die vorher von PSI-RTN nur rückgesetzt werden. 


Anwendersofi-\^are 


PSI - System - Software 


Ebene 16 


Ebene 2 
Ebene! 


Anwender 
Interrupt- 
Routinen 


Anwender- 
generierung 


Sysfem-Makrosbl{ 
Echtzeituhr 
Supervisor-Cail\ 


System- 
initia/isierung 


NSB/DSA 


PSI RTN 


Bild 5.38 

Struktur der mit PSI erzeugten 
Zielsoftware 


Alle zu Objektdateien aufbereiteten Programme werden abschließend zu einem ziel- 
rechnerangepaßten Softwareendprodukt zusammengebunden und auf entsprechende 
Datenträger (EPROM-Speicherschaltkreise) übertragen. 

Bild 5.37 zeigt nochmals den Ablauf und die Bestandteile des Systems PSI, während 
auf Bild 5,38 die Strukturierung der mit diesem System erstellten Software zu sehen ist. 
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6.1. Industrieroboter als programmierbare Systeme 

Als wesentliches Kennzeichen der Industrieroboter ist ihre freie Programmierbarkeit an¬ 
zusehen. Durch die Programmiermöglichkeit sind IR mit anderen programmierbaren 
Systemen vergleichbar, die als Kernstück einen Rechner (Prozessor, Automat) enthalten. 
Der Anwender formuliert die Aufgabe als Programm in einer durch das IR-System vor¬ 
geschriebenen Form (Eingabeform). Das IR-System setzt dieses Programm in Bewegungen 
und Aktionen des IR im technologischen Umfeld um. 

Gegenüber der Programmierung von Rechnern für Datenverarbeitungsprobleme und 
für wissenschaftliche Berechnungen weist die IR-Programmierung eine Reihe von spe¬ 
ziellen Problemen auf. Prinzipiell ist zwischen der externen und der internen Program¬ 
mierung zu unterscheiden (vgl. die Gegenüberstellung innere und äußere Software im 
Abschn. 2.6.). 

Die externe Programmierung dient zur Aufstellung eines Bewegungs- und Aktions¬ 
programms (Roboterprogramm) in einer für den Nutzer handhabbaren Form. Das 
IR-System ist dabei als eine „virtuelle“ Maschine aufzufassen, die wie ein Rechner arbei¬ 
tet (s, Abschn. 2.6.). 

Die interne Programmierung dient zur Programmierung des im IR-System enthaltenen 
Rechners und erfolgt durch den Entwickler des Steuerungs- und Programmiersystems in 
einer Rechnerprogrammiersprache (z. B. MACRO oder PASCAL). 

Spezielle Probleme der externen IR-Programmierung sind darin begründet, daß das 
Programmiersystem den Roboter in einer realen Umwelt steuern muß. Statusänderungen, 
die durch die IR-Aktionen hervorgerufen werden, können durch Sensorsysteme erkannt 
und zur Modifikation der Abarbeitung des Roboterprogramms herangezogen werden. 
Der Grad der Anpassungsfähigkeit ist vom Entwicklungsstand des IR-Systems abhängig 
(vgl. Robotergenerationen im Abschn. 1.). 

An folgendem Beispiel lassen sich die Grundelemente der IR-Programmierung er¬ 
kennen ; 

Beispielaufgabe 

Mehrere Werkstücke sollen von einem Förderband abgenommen und auf einer Palette abgelegt werden. 
Der Ablauf wird mit einer Meldung beendet, wenn keine Werkstücke mehr vorhanden sind bzw. die 
Palette voll belegt ist. 

Lösung 

<Definiere Position Förderband) 

<Definiere Position Palette (Ablage 0)> 

< Definiere Ablagendilferenz für Palette) 

<Definiere Ablagenanzahl) 

<Wicderhole folgende Anweisungen bis Endbedingung erfüllt) 

<Bewege Arm zur Position Förderband) 

<Schließe Greifer) 

<Wenn kein Werkstück, setze Endbedingung) 
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<Palettenposition = Palettenposition + Ablagendifferenz) 

< Ablagenanzahl = Ablagenanzahl — 1) 

<Wenn Ablagenanzahl = 0, setze Endbedingung) 

<Bewege Arm mit Werkstück zur aktuellen Palettenposition) 

< Öffne Greifer) 

<Zyklusende) 

<Gebe Meldung an Bediener) 

<Warte auf Eingabe) 


6.2. Programmierverfahren für Industrieroboter 

Bei der Programmierung von Industrierobotern werden folgende Verfahren unterschie¬ 
den: 

- manuelle Programmierung (Verbindungsprogrammierung), 

- direktes Teach-in, 

- indirektes Teach-in, 

- textuelle Programmierung. 

Diese Verfahren lassen sich z.T. weiter unterteilen. Entscheidend bei allen Program¬ 
mierverfahren ist, ob für die Aufstellung des Programms der Manipulator eingesetzt wird 
oder nicht. In den Fällen, wo der Manipulator zur Programmerstellung nicht gebraucht 
wird, spricht man von einer Off-line-Programmierung. Die anderen Formen bezeichnet 
man mit On-line-Programmierung. Dabei wird der Roboter von Hand durch das Pro¬ 
gramm geführt oder gesteuert und so u. a. als Meßmaschine zur Ermittlung der benötigten 
Raumpunkte und Orientierungen eingesetzt. Die Ofif-line-Prograrnmierung hat den Vor¬ 
teil, daß der Manipulator nicht aus dem laufenden Prozeß herausgenommen werden muß, 
wenn ein neues Programm erstellt wird. Das Verfahren ist jedoch weitgehend auf textuelle 
Programmierung und eine explizite Erfassung und Beschreibung der geometrischen Um¬ 
weltbezüge angewiesen. Da nicht alle Funktionen problemlos off-line programmiert 
werden können, treten verschiedene Mischformen von Programmierverfahren auf. Es sei 
daraufhingewiesen, daß die Bezeichnung der Verfahren nicht einheitlich ist. So heißt z. B. 
das direkte Teach-in auch Folgeprogrammierung. Eine Übersicht zu den verschiedenen 
Programmierverfahren gibt Bild 6.1. 

Tafel 6.1 gibt dazu die bei der Programmierung jeweils auszuführenden Aktionen und 
typische Einsatzfälle für die einzelnen Programmierungsarten an. 

6.2.1. Manuelle Programmierung (Verbindungsprogranunierung) 

Einfache Handhabungsaufgaben (Einlegen, Beschicken von Werkzeugmaschinen) sind 
dadurch gekennzeichnet, daß wenige Positionen im Arbeitsraum sehr häufig und in fester 
Folge eingestellt werden sollen. Für solche Aufgaben sind einfache Steuerungen geeignet. 
Das Programm wird manuell in Form fester Verbindungen eingebracht (Verbindungs¬ 
programmierung). Vom Hersteller solcher verbindungsprogrammierbaren Steuerungen 
werden alle notwendigen Baugruppen geliefert, die der Anwender selbst zusammenschal¬ 
ten muß. Die logische Steuerung kann auf pneumatischer, hydraulischer, mechanischer 
oder elektrischer Basis arbeiten. Die einzelnen Haltepunkte der einstellbaren Achsen las¬ 
sen sich z.B. durch Anschläge realisieren und liegen daher als Positionen in Roboter¬ 
koordinaten vor. Die manuelle Programmierung ist einfach zu realisieren; für einen 
flexiblen Einsatz ist sie jedoch wenig geeignet, da der Umrüstungsaufwand relativ groß ist. 



Programmierverfahren 
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Tafel 6.1. Programmierungsarten von Industrierobotern ~ Charakteristika und typische Einsatzfälle 



Programmierungsart 

Manuell 

Teach-in 

direkt 

indirekt 

Textuell 

Programmierung von 

Bewegungen/ 

Positionen 

Potentiometer 

Ziffern- 

wahlschalter 

Vorführen 
mit echtem 
oder proportio¬ 
nalem Zeit¬ 
bezug 

Anfahren und 
Speichern 

textuelle Eingabe 
am Bedienfeld 
oder Programm¬ 
eingabe von 
einem externen 
Speichermedium 

Aktionen 

Stecken von 
Verbindungen 

textuelle Ein¬ 
gabe am 
Programmier¬ 
gerät 

Programmabläufen 

textuelle Ein¬ 
gabe am Bedien¬ 
feld 

Typische Einsatzfälle 

Beschicken 

Farbspritzen 

Punktschweißen 

Lichtbogen¬ 

schweißen 

Montage 








1 



Die manuelle Herstellung der Verbindungen hat nur sehr wenig gemein mit dem üb¬ 
lichen Begriff Programmierung. Allerdings kann man solche Verbindungen auch durch 
Umsetzen von Logikplänen realisieren und in einer Textform (Programm) beschreiben 
(s. Abschn.8.4.). 


6.2.2. Teach-in-Programmierung 

Zur Teach-in-Programmierung werden alle Verfahren gerechnet, bei denen die Bewe¬ 
gungsbahn durch Bewegen oder Verfahren des IR-Grundgeräts definiert wird. Das Ein¬ 
stellen der gewünschten Positionen kann dabei auf verschiedene Weise erfolgen. Man 
unterscheidet diese Verfahren nach der Art der Bewegung des IR-Geräts in 

- direktes Teach-in 

- indirektes Teach-in. 

Allen Teach-in-Verfahren ist gemeinsam, daß über die Positionsmeßsysteme die Stellun¬ 
gen der einzelnen Achsen zu bestimmten Zeitpunkten eingelesen und in einen Speicher 
für die spätere Bearbeitung der Programme abgelegt werden (Play-back-Verfahren, 
Taperecordermode). Der IR wird bei der Programmierung als Meßmaschine benutzt. 


6.2.3. Direktes Teach-in 

Bei diesem Verfahren wird der IR in der Programmierphase direkt bewegt. Die einfachste 
Art besteht darin, den Effektor bei gelösten Bremsen von Hand in die gewünschten Posi¬ 
tionen zu bringen und die aktuellen Werte der Lagesensoren auf Anweisung (Funktions¬ 
taste) einzuspeichern. Das Verfahren wird auch Einstellverfahren genannt. 
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Der Zeitaufwand für die Programmierung einer komplexen Aufgabe kann sehr hoch 
werden, wenn die Zahl der einzustellenden Punkte groß ist. Das Einstellverfahren muß 
zur vollständigen Definition von Bahnen zusätzliche Komponenten zur Einstellung des 
zeitlichen Ablaufs (Geschwindigkeit oder Zeit) enthalten. Diese Notwendigkeit besteht 
nicht, wenn die Steuerung den Bewegungsablauf zu bestimmten Zeitpunkten selbständig 
abtastet und die aktuellen Bahndaten (Bewegungspunkte und durchzuführende Aktio¬ 
nen) in den Speicher überträgt. Ein solches Verfahren nennt man auch Folgeprogram¬ 
mierung. 





Bild 6.2 

Varianten des direkten Teach-in 

a) direkte Bewegung des Industrieroboters bei frei¬ 
geschalteten Antrieben, Übernahme der Positionen 
von den IR-Meßsystemen; b) Steuerung des IR über 
ein Programmierhilfsgerät, Übernahme der Positio¬ 
nen von den IR-Meßsystemen; c) Bewegung des 
Hilfsgeräts allein, Übernahme der Positionen von 
den Meßsystemen des Hilfsgerätes 


Die Folgeprogrammierung wird vorwiegend im technologischen Bereich (Farbspritzen) 
eingesetzt (Bild 6.2a), 

Ein erfahrener Facharbeiter führt dabei den IR mit der Hand in der gewünschten kon¬ 
tinuierlichen Form mit der erforderlichen Geschwindigkeit. 

Die Steuerung muß dabei aus dem Bahn verlauf heraus notwendige Stützstellen bilden. 












Bild 6.3. Datenflüsse bei Verfahren der direkten Teach-in-Programmierung 

a) Datenfluß zu Bild 6.2a; b) Datenfluß zu Bild 6.2b; c) Datenfluß zu Bild 6.2c 
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zwischen denen im späteren Arbeitsablauf interpoliert werden kann. Die Anzahl der ab¬ 
zuspeichernden Punkte kann, in Abhängigkeit vom technologischen Programm, sehr groß 
sein, und es müssen geeignete Berechnungsverfahren zur Interpolation eingesetzt werden. 
Bei dem direkten Einstellverfahren und der beschriebenen Form der Folgeprogrammie¬ 
rung wird vorausgesetzt, daß sich der IR von Hand bewegen läßt. Das ist z.B. bei elek¬ 
trischen Antrieben mit stark untersetzenden (selbsthemmenden) Getrieben nicht ohne 
weiteres möglich. Beim Master-Slave-Verfahren wird diese Schwierigkeit dadurch über¬ 
wunden, daß ein leichter Mpdellroboter (Master) vom Programmierer geführt und die 
Bewegung vom Master auf den eigentlichen IR (Slave) übertragen wird (Bild 6.2b und c). 
Der Vorteil dieses Verfahrens besteht darin, daß die Programmierung für den Bediener 
wesentlich leichter wird und er nicht im unmittelbaren Arbeitsbereich des IR stehen muß. 
Die technische Ausrüstung ist allerdings wesentlich aufwendiger, da einige Komponenten 
doppelt bzw. als Modell aufzubauen sind. Äußerlich ist die Master-Slave-Programmie- 
rung mit der Bedienung von Teleoperatoren vergleichbar, bei denen jedoch keine Spei¬ 
cherung der Bahndaten erfolgt. Die Folgeprogrammierung läßt sich durch Bewegen über 
den eigenen Antrieb des IR realisieren, wenn der Effektor über einen optischen Sensor 
einer vom Programmierer geführten Lichtquelle folgt. Das gleiche kann auch mit taktilen 
Sensoren erreicht werden. Die Steuerung bildet dabei einen Regelkreis, für den die Soll¬ 
werte durch den Programmierer vorgegeben werden. 

Bild 6.3 zeigt abschließend die den einzelnen Varianten des direkten Teach-in aus 
Bild 6.2 entsprechenden Verarbeitungsstrukturen. 

6.2.4. Indirektes Teach4n 

Beim direkten Teach-in wird der IR durch Betätigen von Funktionstasten durch seine 
eigenen Antriebe bewegt. Ist eine gewünschte Position eingestellt, so wird über eine wei¬ 
tere Funktionstaste das Einlesen der Achsstellungen von den Lagesensoren angegeben 
und der Punkt mit weiteren Angaben zur Bahn in dem Speicher des Steuerrechners ab- 



Bild 6.4. Indirekte Teach-in-Programmierung 
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gelegt (Bild 6.4). Zur Programmierung werden Hilfsmittel eingesetzt, um bestimmte 
Funktionen aufrufen zu können. Solche Programmiereinheiten sind ausgeführt als ein¬ 
fache Tastenfelder mit optischen Anzeigen oder bei fortgeschrittenen Systemen auch mit 
vollständiger alphanumerischer Tastatur und Bildschirmanzeige. Das indirekte Teach-in 
ist das z. Z. am häufigsten eingesetzte Programmierverfahren. Auch bei höheren Mani¬ 
pulatorsprachen findet man häufig zur Definition von wichtigen Punkten im Arbeitsraum 
Teach-in-Komponenten vor (z.B. POINTY beim Programmiersystem AL; s. Abschnitt 
6.2.8.). Der Übergang zu Systemen mit textueller Programmierung ist fließend, da zu den 
über Funktionstasten eingegebenen Befehlen häufig weitere Angaben zur Bahnsteuerung 
programmiert werden müssen. Die Darstellung der Anweisungen in Textform für ein¬ 
fache Programmiersysteme wird im Abschnitt 6.2.6. beschrieben. Die dazu erforder¬ 
lichen Teach-in-Hilfsmittel sollen im folgenden am Beispiel der Steuerung IRS 600 für 
den IR2 erläutert werden. 

Der Bediener tastet die Arbeitsaufgabe unter Verwendung eines Teach-in-Tableaus 
Bild (6.5) in die Robotersteuerung ein und betätigt dabei Tasten für 

- Betriebsarten 

- Verfahrgeschwindigkeit 

- Wegebedingungen 

- Achsenpositionen 

- Unterprogrammaufruf 

- Programmauswahl 

- Programmablauf u.ä. 

Die Funktionstasten sind entsprechend ihrer Funktion beschriftet und können leicht 
ausgewählt werden. Im Hintergrund dieser Eingaben steht eigentlich eine Programmier¬ 
sprache (z. B. NC-Sprache bei IRS 600). Das ist bei einer Programmierung über Terminal 
sehr leicht zu erkennen. Eine Programmierbox hat den Vorteil, daß sie wesentlich weniger 
Aufwand in der Realisierung erfordert als ein Terminal und beweglicher eingesetzt wer¬ 
den kann. Für umfangreiche Sprachsysteme, die z. B. eine werkstücksbezogene Koordi¬ 
natenangabe zulassen, sind Funktionstasten mit einer starren Zuordnung nur noch be¬ 
dingt geeignet. 

Der Funktionsinhalt einzelner Tasten ist dann abhängig von der eingestellten Betriebs¬ 
art, und vom Bediener wird eine genaue Kenntnis der zeitlichen Reihenfolge der Tasten¬ 
betätigung gefordert. Der Vorteil einer einfachen Tastenbedienung kommt nur zum Tra¬ 
gen, wenn das Bediengerät übersichtlich gestaltet ist und solche Funktionsumschaltungen 
leicht zu erkennen sind. 

Die Beschreibung der Bahn erfolgt beim indirekten Teach-in weitgehend in Roboter¬ 
koordinaten, d.h., für jede Achse gibt es fest zugeordnete Tasten (bei kartesischen IR 
z. B. für die Achsen Y, Y, Z, A, Cund bei Gelenk-IR für jedes Drehgelenk eine bzw. zwei 
für Drehung in positiver oder negativer Richtung). Die Tasten sind vom Programmierer 
so lange zu betätigen, bis eine gewünschte Position erreicht ist. Der Vorteil des reinen 
Teach-in-Verfahrens besteht darin, daß Programme on-line erstellt, getestet und korri¬ 
giert werden können, und zwar durch den Maschinenbediener am Bearbeitungsort. Das 
Verfahren kann wie beim direkten Teach-in durch zusätzliche Hilfsmittel unterstützt wer¬ 
den. So werden z.B. Steuerknüppel eingesetzt, bei denen gleichzeitig eine Bewegung in 
mehreren Achsen angegeben werden kann. Durch einen Steuerknüppel lassen sich Posi¬ 
tionen oder Bewegungsrichtungen in der x:->^-Ebene einstellen. Zur Realisierung einer 
räumlichen Punktbeschreibung ist die z-Komponente durch einen zusätzlichen Hebel 
o.ä. zu realisieren. 
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Bildet der IR mit seinen Achsen keinen kartesischen Arbeitsraum, so ist durch die 
Steuerung eine Koordinatenumrechnung durchzuführen. Das Verfahren entspricht etwa 
dem Master-Slave-Verfahren, wobei natürlich konstruktionsbedingte Einschränkungen 
gelten. Der Steuerknüppel ist besonders vorteilhaft, wenn für die Bewegung im Arbeits¬ 
raum starke Restriktionen gegeben sind (z.B. Bewegung einer Schweißzange durch die 
Fensteröffnung einer Kfz-Karosserie). Mit dem indirekten Teäch-in lassen sich sowohl 
einfache Punkt-zu-Punkt-Steuerungen (PTP) als auch Bahnsteuerungen (CP) realisieren. 
Bei der Programmierung komplexer Abläufe ist die Angabe zusätzlicher Daten zur Ob¬ 
jekt- und Bahnbeschreibung erforderlich, und die einfache Teach-in-Programmierung 
wird durch Verfahren der textuellen Programmierung abgelöst. 
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Bild 6.5. Handbedieneinheit für indirektes Teach-in (IRS 600) 

Betriebsarten: Satzsuchlauf (SASU); Automatik (AUT); Schrittautomatik (SAAUT); Einrichten (EINR); Teach-in-Betrieb 
(TEACH); Quittierung M-Befehle (QUIM); Generierung von G-Befehlen und von Variablen 

Befehlstasten; Generierung der M-Befehle (GEN); G G-Befehle (Zeit- und Wegebedingungen); L L-Befehle (UP-Nummer); 
M M-Befehle (Hilfsbefehle); N N-Befehle (Satznummer); F F-Befehle (Verfahrgeschwindigkeit); V V-Befehle (Variable für 
M-Befehle); Leserstart (LES); Stanzerstart (in Verbindung mit KOR); Ausführung eines eingegebenen; Satzes (REAL); 
Korrigieren (KOR) 

Funktionstasten (wirksam bei EINR und TEACH): A Ansteuerung Achse A \ C Ansteuerung Achse C; X Ansteuerung 
Achse X-, Y Ansteuerung Achse Y; Z Ansteuerung Achse Z; Rohteilgreifer öffnen/schließen (GR OE, GR S); 
Fertigteilgreifer öffnen/schließen (GF OE, GF S); TI, T2 Takteinrichtung 1/2 drehen um einen Schritt 
Numerische Tastatur:. H— Richtung positiv/negativ; Anzeige/Löschen bei G- und V-Befehlen; 0 bis 9 Zifferneingabe 


Als Basiszyklus sind beim indirekten Teach-in immer folgende Schritte erforderlich: 

- Einstellen der Verfahrgeschwindigkeit (Schalter, Potentiometer); 

- Betätigen von Tasten, die eine Bewegung der zugeordneten Achsen bewirken; 

- Speichertaste betätigen, wenn Zielpunkt erreicht. 
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Zusätzliche Angaben zur Bahn (z.B. Bewegung auf einer Geraden) werden durch ge¬ 
sonderte Tasteneingaben realisiert. Ein Beispiel für die IRS-600-Programmierung wird im 
folgenden Abschnitt in textueller Form angegeben. Die Texte entstehen durch entspre¬ 
chende Tastenauswahl. 


6.2.5. Textuelle Programmierung 

Textuell bedeutet hier, daß der Algorithmus, der die Aufgabenstellung umsetzt, in Form 
eines lesbaren Textes erstellt und vom Programmiersystem in eine für die IR-Steuerung 
geeignete Form umgesetzt wird. Der Text ist eine symbolische Beschreibung von Opera¬ 
tionen und Daten in Form von zulässigen Zeichenfolgen einer Programmiersprache. 

Die textuelle Formulierung einer Aufgabe bietet im Vergleich zur reinen Teach-in- 
Programmierung eine Reihe von Vorteilen [6.10]: 

- Das Programm ist für den Programmierer und andere Anwender lesbar (mitteilbar), 

- Das Programm läßt sich leicht ändern (editierbar). 

- Daten sind als Variablen darstellbar, deren Wert erst zur Ablaufzeit ermittelt und ein¬ 
getragen wird (z. B. Sensordaten). 

- Das Programm kann in lesbarer Form gespeichert werden (Dokumentation). 

- Das Programm kann off-line (ohne IR) erstellt und teilweise kontrolliert und getestet 
werden. 

Als Nachteile der textuellen Programmierung sind zu nennen: 

- Das Programmiersystem ist komplexer und aufwendiger in der Realisierung (Hard¬ 
ware und Software). 

- Die Bewegungspunkte lassen sich nicht vollständig off-line beschreiben; es ist meistens 
zusätzlich eine Teach-in-Komponente erforderlich, die on-line in einem Testlauf die 
fehlenden Angaben ergänzt. 

- Die Programmiersprache erfordert i.allg. eine höhere Qualifikation des Programmie¬ 
rers als eine einfache Tastenbedienung. Die erforderliche Qualifikation ist natürlich 
von der Anpassung der Sprache an die Problemstellung abhängig (Fachsprache). 

Die textuelle Programmierung gewinnt gegenüber der reinen Teach-in-Programmie¬ 
rung ständig an Bedeutung. Als eine Variante der textuellen Programmierung ist die 
akustische Programmierung anzusehen, bei der ein Text nicht als symbolische Zeichen¬ 
folge über Tastatur oder Datenträger, sondern über ein Sprachanalysesystem eingegeben 
wird. Die Komplexität der Sprache wird dabei vorwiegend durch die Leistungsfähigkeit 
des Sprachanalysesystems bestimmt. Ein Vorteil der akustischen Programmierung liegt 
darin, daß die Eingabe ohne mechanische Hilfsmittel erfolgen kann und der Program¬ 
mierer bei der Festlegung des Arbeitsablaufs die Hände frei hat für andere Aufgaben 
(z.B. Werkstückzuführung), die später durch andere technologische Einrichtungen reali¬ 
siert werden. 


6.2.6. Daten und Befehle im Robcterprogramm 

Ein Programm besteht formal aus zwei Bestandteilen: 

- Objektbeschreibungen in Form von Datenstrukturen, 

- Befehlen, die mit den Datenstrukturen operieren. 
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Bild 6.6. Programmstrukturelemente für IR-Programme (nach [6.11]) 
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Programme in einer IR-Programmiersprache unterscheiden sich von Programmen in 
einer normalen Rechnerprogrammiersprache dadurch, daß spezifische Datenstrukturen 
(z. B. Bewegungspunktbeschreibungen) und spezielle Befehle enthalten sind. Programm¬ 
strukturelemente von Industrieroboter sprachen sind im Bild 6.6 zusammengefaßt. Diese 
Sprachelemente dienen zur Beschreibung von 

- Trajektorien (Positionen, zeitlicher Ablauf), 

- Werkstückgeometrie und Relationen zwischen Objekten, 

- Sensordaten, 

- Programmstrukturen, 

- Steuerungsabläufen und möglicherweise 

- arithmetischen Operationen. 

Allgemein lassen sich die Daten (Objekte) als Elemente eines Umweltmodells auffassen, 
das entweder explizit inj Programm aufgestellt (explizite Programmierung) oder aus einer 
Datensammlung generiert wird (implizite Programmierung). 

Beim Entwurf einer IR-Sprache kann man prinzipiell zwei Wege gehen. Entweder wird 
eine vorhandene Rechnerprogrammiersprache um roboterspezifische Konstruktionen 
ergänzt, oder es wird eine gesonderte Sprache entwickelt. So existieren heute einerseits 
Sprachen, die wie PASCAL oder BASIC aufgebaut sind, und andererseits spezielle 
IR-Sprachen, die auch Erweiterungen von NC-Sprachen darstellen können. 

Auf einige Sprachrealisierungen wird in den folgenden Abschnitten eingegangen. Eine 
vollständige Übersicht ist nur noch schwer zu erreichen, da die Zahl der Sprachen bereits 
recht groß ist [6.27]. Es ist zu erwarten, daß sich auch hier internationale Standards her¬ 
ausbilden werden, wie das im Bereich der NC-Sprachen bereits geschehen ist. 

Beim Entwurf einer Sprache ist festzulegen, welche Objekte (Datenstrukturen) durch 
welche Operationen bearbeitet werden können. Diese Festlegungen sind dann in Form 
der Syntax der Sprache für die Programmierung verbindlich. Abweichungen werden durch 
das Programmiersystem erkannt und als Fehler angezeigt. 


6.2.7. Einfache Manipulatorsprachen 

Ein Programm in einer einfachen Manipulatorsprache beschreibt explizit die Bewegung 
des Effektors auf einer durch Bewegungspunkte im Arbeitsraum des IR beschriebenen 
Trajektorie und die zugehörigen Aktionen. Dabei müssen alle Komponenten der Steue¬ 
rung und des Manipulators durch entsprechende Sprachelemente angesprochen werden 
können. Diese Sprachebene realisiert damit eine virtuelle (programmierbare) Maschine, 
deren Befehle in Echtzeit on-line den Roboter steuern. Das entspricht der Assembler¬ 
programmierung eines Rechners, bei der alle Rechnerfunktionen durch Maschinenbefehle 
realisiert werden. 

Zur Formulierung der Ärbeitsaufgabe in einer einfachen Manipulatorsprache wird der 
Programmtext über einen Editor in den Speicher eingetragen und nach einfachen Kri¬ 
terien überprüft. Der Programmierer hat die Möglichkeit, den Text beliebig zu ändern 
und auf einem Datenträger (z.B. Magnetband oder Floppydisc) auszugeben. Die Um¬ 
setzung des Textes in eine für die Steuerung geeignete Form ist von der Komplexität der 
Sprache und dem zugehörigen Programmiersystem abhängig. Im einfachsten Fall wird 
die Eingabeform direkt vom Editor syntaktisch überprüft und in eine kompakte interne 
Darstellung umgewandelt, die dann vom Interpreter ausgewertet wird. Die Definition der 
Bewegungspunkte kann dabei während der Programmeingabe über Teach-in erfolgen 
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oder in einem separaten Testlauf, bei dem zunächst symbolisch angegebene Bahnpunkte 
interaktiv angefordert oder auch durch Berechnung bereitgestellt werden. 

Je nach Ausführung der Steuerung erfolgt die Programmierung der Bewegungspunkte 
in robotereigenen und/oder in Umweltkoordinaten. 




b) 


Bilde.? 

Programmierung in Roboterkoordinaten 
a) Aufnahme; b) Wiedergabe 



Bild 6.8. Programmierung in Umweltkoordinaten 

a) Aufnahme; b) Wiedergabe 
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6. Programmierung von Industrierobotern 


Tafel 6.2. IR-Sprache TIPS H [6.12] 


TIPS II 


Pseudo-Kommandos 


Geschwindigkeitsangabe 

VA 

Automatikbetrieb 

VK 

Korrektur im Befehl 

VT 

Testbetrieb 

VM 

Handbetrieb 

Kontrollfunktionen 

SN 

Schnappschuß 

LD 

Laden Programm von ROM 

UM 

Umschalten Programmbereich 

SU 

Substitution von Byte 

Betriebsarten/Ablaufsteuerung 

TI 

Teach-in im RAM 

EX 

Beenden Teach-in 

ST 

Einzelschritt-Modus 

LI 

Wiederholter Einzelschritt 

CTRL/C 

Halt (STOP) 

CTRL/X Abbruch (ABORT) 

Editor-Kommandos 

B 

Zeiger auf Beginn 

Z 

Zeiger auf Ende 

±n L 

Zeiger n Zeilen vorwärts/rückwärts 

±nT 

Terminalausgabe von RAM-Zeilen 
CTRL/S = STOP 

CTRL/Q = CONTINNE 

CTRL/C = CANCEL 

±n K 

Streichen von RAM-Zeilen 

<ESC> 

Aufruf des Editors 
in Betriebsart TI 

<ESC> 

<ESC> Abschluß eines 

Editorkommandos 


Programm-Kommandos 


Geometrieanweisungen 
GP Grobpositionierung 
FP Feinpositionierung 
BG berechnete Grobposition 
BF berechnete Feinposition 
LP Linearpositionierung 
CP Bahnsteuerung 

Ablaufanweisungen 
LB Marke Setzen 
JU Sprung 
JC Sprung bedingt 
CA Unterprogrammaufruf (UP) 

CC UP-Aufruf bedingt 
RE UP-Rücksprung 
RC UP-Rücksprung bedingt 
DO Programmschleife von/bis 
BR Abbruch Programmschleife 
CL Abarbeitung Kommandofolge 
SF Merkbit Setzen/Rücksetzen 
BS Byte-Substitution 
SE Suchfunktion (Monitor) 

SA Abbruch Suchfunktion 
SP Start Nebenprogramm 
WP Warten auf Nebenprogramm 
WT Warten von Zeitfakten (0,1 s) 

Kontroll-/Überwachungsanweisungen 
WB Warten auf Binäreingabe 
BO Binärausgabe 
GA Greifer auf 
GZ Greifer zu 

Sonstige Anweisungen 
KO Kommentarzeile 


Bei der Programmierung in Roboterkoordinaten bleibt das Programm weitgehend vom 
konkreten Robotertyp abhängig. In der Programmierphase werden die Bewegungspunkte 
über die Teachbox angesteuert und in roboterspezifischen Koordinaten abgespeichert 
(Bild 6.7 a). Geschwindigkeiten, Aktions- und Programmorganisationsbefehle werden 
über das Bedienfeld eingegeben. Während der Programmausführung übernimmt der 
Interpreter die Bewegungspunkte mit den zusätzlichen Angaben aus dem Speicher. Die 
Trajektorienplanungistauf eine einfache Interpolation in Gelenkkoordinaten beschränkt. 
Sie stellt die Sollwerte für die Servoregelung bereit (Bild 6.7 b). 

Bei der Programmierung in Umweltkoordinaten werden die Position und Orientierung 
des Effektors in natürlichen, meist kartesischen Koordinaten abgespeichert (Bild 6.8 a). 
Damit ist auch die Anwendung des Framekonzepts (s. Abschn. 4.6.7.) für den Anschluß 
äußerer Sensoren gewährleistet. Beim Anfahren der Bewegungspunkte und bei der Pro- 
grammarbeitung macht sich eine inverse Koordinatentransformation (von Umwelt¬ 
koordinaten in roboterspezifische Koordinaten) erforderlich. Die Trajektorienplanung 
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6. Programmierung von Industrierobotern 


umfaßt jetzt die Generierung von Raumkurven aus wenigen Vorgaben und umfassende 
Modifikationen von Bewegungsdaten. Dadurch können Bewegungsprogramme wesent¬ 
lich kompakter gespeichert und einfacher geändert werden. 

Als Beispiel für eine einfache Programmiersprache mit integrierter Teach-in-Kompo- 
nente für das Roboterkoordinatensystem soll die Sprache TIPS II zur Steuerung der 
Gelenkroboter ZIM 60 und ZIM 10 dienen. In Tafel 6.2 ist die Syntax von TIPS II zu¬ 
sammengestellt [6.12] [6.13]. Die Eingabe von Roboterkoordinaten erfolgt während der 
Programmerstellung im indirekten Teach-in (Befehle GP, FP, LP, CP). 

Eine weitere einfache Programmiersprache ist die von der NC-Programmierung ab¬ 
geleitete Form der IRS 600 für den Beschickungsroboter IR 2. Als Vorteil dieser Sprache 
ist zu nennen, daß sie die Erfahrungen der NC-Programmierung direkt übernimmt und so 
eine einfache Programmierung von Robotern an NC-Maschinen ermöglicht. Nachteilig 
ist, daß sie nur wenige Elemente zur Programmablaufsteuerung enthält und nicht sehr 
anschaulich ist. Tafel 6.3 enthält eine Syntaxbeschreibung der IRS-600-Programmier- 
sprache [6.14]. Die Roboterkoordinaten werden explizit oder durch Anfahren und Ab¬ 
speichern bereitgestellt. 

Das folgende Beispiel aus der Bedienungsanleitung [6.14] soll die Arbeitsweise mit einer 
IR-Sprache auf NC-Basis deutlich machen. 

Beispiel IRS-600-Programmierung 

Aufgabenstellung für IR2 (3 NC-, 2 Nockenachsen). 

Ein Teil soll von der Position 1 {x = 10000, z = 20000, c = 12000) mit dem Rohteil¬ 
greifergeholt, auf Position 2 (x = 30000, z = 50000, c = 500) abgelegt, mit dem Fertig¬ 
teilgreifer wieder aufgenommen und zurück zur Position 1 gebracht werden. Dieser Vor¬ 
gang soll zehnmal wiederholt werden. Die Ausgangsposition ist Position 3 (x = 1000, 
z = 1000, c = 100). Geschwenkt werden soll mit x = 5000, Zur Angabe der Festposi¬ 
tionen werden G-Befehle generiert und für Hilfsfunktionen M-Befehle genutzt. 


G- und M-Befehle 


GO 

= 

10 

Wartezeit 1 s 

G12 

= 

5000 

5 cm Abhebemaß in Z 

G17 

= 

4800 

4,8 cm Absenkmaß in Z für Ablage 

G21 

= 

20000 

20 cm Position 1 in Z 

G22 

= 

50000 

50 cm Position 2 in Z 

G23 

= 

1000 

1 cm Position 3 in Z 

G41 

= 

10000 

10 cm Position 1 inA" 

G42 

= 

30000 

30 cm Position 2 in X 

G43 

= 

1000 

1 cm Position 3 in A" 

G44 

= 

5000 

5 cm Schwenkposition in X 

G61 

= 

12000 

Position 1 in C 

G62 

= 

500 

Position 2 in C 

G63 

= 

100 

Position 3 in C 

M40 

= 

V25 0086 

Zyklusende bei erreichtem Grenzwert 

M56 

= 

V41 0004 

Zähler erhöhen, falls Greifer offen 

M60 

= 1 

I V53 0052 

Rohteilgreifer öffnen 

MlOO 


schließen 

M61 

= ] 

I V54 0152 

Fertigteilgreifer öffnen 

MlOl 

= J 

schließen 
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Zähler (Zwischenspeicher 1) 

V85 = 0010 Anfangs wert 00, 10 Zyklen 


Programm 


%L1 


Unterprogramm Nr. 1 

NOl 

G23 G43 G63 

Position 3 


M96 

Löschen Zähler 1 


M60 M61 

Greifer öffnen 


Y2 

T-Achse Stellung 2 

N02 

M95 

Zyklusbeginn 

N03 

G21 G12 A3 

Z-Position 1, oberhalb Teil 

N04 

G41 G61 

X, C-Position 1 

N05 

G21 

Z-Position 1 

N06 

MlOO GO 

Rohteilgreifer schließen, warten 

N07 

G12 

Abheben 

NOS 

G44 

Schwenkposition für X 

N09 

G62 

Schwenken in C-Position 2 


G22 G12 

Z-Position 2, oberhalb Ablage 

NIO 

G42 

V-Position 2 

Nil 

G17 

Absenken 

N12 

M60 

Rohteilgreifer öffnen 

N13 

G12 

Abheben 

N14 

G44 

X Zurückfahren 

N15 

Al 

A Schwenken 

N16 

G42 

X wieder vor (Position 2) 

NI7 

G22 

Z-Position 2 

N18 

MlOl GO 

Fertigteilgreifer schließen, warten 

N18 

G12 

Abheben 

N20 

G44 

Schwenkposition für X 

N21 

G61 

Schwenken in C-Position 1 


G21 G12 

Z-Position 1, oberhalb Ablage 

N22 

G41 

Y-Position 1 

N23 

G17 

Absenken 

N24 

M61 

Fertigteilgreifer öffnen 

N25 

G12 

Abheben 

N26 

G44 

X Zurückfahren 

N27 

M56 

Zähler erhöhen 

N28 

M40 M2 

Zyklus beenden, wenn Grenzwert 

N29 

M94 

Unterprogrammende 


An diesem Beispiel wird bereits deutlich, daß die Programmierung der Aufgabe sehr 
gut vorbereitet werden muß und ein Verständnis der Befehle wegen fehlender Mnemonik 
nur mit Tabellen möglich ist. 

Die NC-Sprachen sind in, einigen Anwendungsfällen stärker auf die IR-Steuerung zu¬ 
geschnitten und weiterentwickelt worden. Etwa die gleiche Leistungsfähigkeit wie die 
IRS-600-Sprache bietet die Sprache RPL [6.15]. Der sehr formale Satzaufbau ist 
durch eine mehr problemorientierte, symbolische Darstellung der Anweisungen ersetzt 
(Tafel 6.4) 
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Als Beispiel einer Sprache zur Programmierung in Umweltkoordinaten wird im folgen¬ 
den die Sprache VAL für den IR PUMA (Unimation) dargestellt [6.7] (Tafel 6.5). Die 
Programmierung der Bewegungspunkte erfolgt durch die Angabe von Frames (s. Ab¬ 
schnitt 4.6.7.) und Transformationen als Beziehungen zwischen Frames im Teach-in- 
Verfahren. Die Programmform ist an die Rechnerprogrammiersprache BASIC angelehnt. 


RPL 

Programm-Kommandos 

Geometrieanweisungen 

X 

x-Translation 

z 

z-Translation 

c 

c-Rotation 

D 

D-Rotation (Hand) 

E 

E-Rotation (Hand) 

S 

Überschleifparameter 

ABS 

Absolute Koordinaten 

REL 

Relative Koordinaten 

Ablaufanweisungen 

WAIT 

Warten von Zeittakten (0,1 s) 

STOP 

Programmstop 

GOTO 

Sprung 

DO 

Schleifenbeginn 

CONTINUE 

Schleifenende 

CALL 

UP-Aufruf 

ENTRY 

UP-Einsprung 

RETURN 

UP-Rücksprung 

IF... 


WAIT 

Warten bedingt 

STOP 

Stop bedingt 

GOTO 

Sprung bedingt 

CALL 

UP-Aufruf bedingt 

RETURN 

UP-Rücksprung bedingt 

TI ON 

Ausgabesignal bedingt 

Kontroll- und Überwachungsanweisungen 

F 

Verfahrensgeschwindigkeit 


Tafel 6.4 

IR-Sprache RPL [6.15] 


Die Verarbeitung erfolgt durch einen Interpreter. Das Programm bleibt dadurch stets im 
Quelltext lesbar, und Programmkorrekturen lassen sich sehr einfach ausführen. Zur Syn¬ 
chronisation mit dem technologischen Prozeß sind einfache binäre Eingabe- und Aus¬ 
gabebefehle vorhanden. Der Anschluß von Sensoren, die den Zahlenwert einer Meßgröße 
liefern, ist nicht vorgesehen. Eine Spracherweiterung für das visuelle Erkennungssystem 
VS 100 (UNIVISION) gestattet die Verwendung von Positionsvariablen, deren Werte erst 
zur Ausführungszeit festgelegt werden [6.16]. Durch die Anwendung von relativen und 
zusammengesetzten Koordinaten Vorgaben lassen sich sehr einfach Unterprogramm- 
bibliotheken aufbauen, die zur Generierung umfangreicher Programme verwendet wer¬ 
den können. 

Das folgende Beispiel gibt ein einfaches Programm zum Entladen einer Palette an. 
Dabei wird ein Unterprogramm zur Bestimmung der Palettenpositionen aufgerufen. 
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Tafel 6.5. IR-Sprache VAL [6.7] 


VAL 


Monitor-Kommandos 

Programm-Kommandos 

Bewegungspunktdefinition 

Geometrieanweisungen 

POINT 

Zuweisung 

ALIGN 


DPOINT 

Löschen eines Punktes 

APPRO (S) 

definierte Annäherung 

HERE 

aktuelle Position 

DEPART (S) definierte Entfernung 

WHERE 

aktueller Zustand 

DRAW 

Positionierung relativ 

TEACH 

Zuweisung einer Folge im 

DRIVE 

Ansteuerung einer Achse 


Teach-Modus 

MOVE (S)(T) Positionierung 

BASE 

Basissystem 

NEST 

Ruheposition 

TOOL 

Werkzeugtransformation 

READY 

Bereitschaftsposition 



ENABLE CP kontinuierliche Bahn 

uescnwindigkeitsangaoe 

SPEED Monitorgeschwindigkeit 

FRAME 

HERE 

Bezugssystem 
aktuelle Transformation 

Betriebsarten 


INVERSE 

inverse Transformation 

EXECUTE 

Programmabarbeitung 

SET 

Zuweisung 

ABORT 

Abbruch 

SHIFT 

Verschiebung 

NEXT 

Einzelschritt 

TOOL 

Werkzeugtransformation 

CALIBRATE 

Kalibrierung 

COARSE 

Grobtoleranz 

DO 

Befehlsausführung 

FINE 

Feintoleranz 

STATUS 

Zustandsangabe 

BASE 

Basisbezugssystem 

EDIT 

C 

Start Editor 

Programmwahl 

Ablaufanweisungen 

GOTO Sprung 

GOSUB UP-Aufruf 

D 

Löschen von Zeilen 

Ende Editor 

Einfügen 

Positionieren vor/zurück 

RETURN 

UP-Rücksprung 

I 

L/P 

IF THEN 

bedingter Sprung 

STOP/HALT Programmende 

R 

Ersetzen 

Kontroll- und Überwachungsanweisungen 

S 

Positionieren auf Schritt 

IFSIG THEN bedingte Reaktion 

T(S) 

Teach in Gelenkkoordinaten 

REACT (I) 

Start Bedingungsmonitor 


(analog TEACH) 

IGNORE 

WAIT 

Ende Bedingungsmonitor 

Warten auf Eingabesignal 
Ausgabesignal 

Bibliotheksverwaltung 

SIGNAL 

DIRECTORY Inhaltsverzeichnis 

SPEED 

Verfahrensgeschwindigkeit 

LISTE 

Auflistung von Punkten 

OPEN (I) 

Öffnen des Greifers 

LISTP 

Auflistung von Programmen 

CLOSE (I) 

Schließen des Greifers 

FORMAT 

Formatieren Floppy 

GRASP 

Greifen 


SETI 

Integerzuweisung 



Kommunikationsanweisungen 



TYPE (I) 

Ausgabe von Zahl/Text 



PAUSE 

Ausgabe und Eingabe 



REMARK 

Kommentar 


Beispiel 

VAL-Programm zum Entladen einer Palette 


BASE 

0.00, 0.00, 0.00, 30.00 

SETI 

MAX. REIHE = 6 

SETI 

MAX. SPALTE = 12 

SETI 

REIHE = 1 

SETI 

SPALTE =1 

SET 

POSIT = ANFANG 
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20 APPRO POSIT = 50.00 
MOVES POSIT 
CLOSET 0.00 
MOVE 

GOSUB PALETTE 
GOTO 20 
RETURN 0 

Unterprogramm PALETTE 

REMARK NEUE PALETTENPOSITION 
SETI SPALTE = SPALTE + 1 

IF SPALTE GT MAX. SPALTE THEN 10 

SHIFT POSIT BY 30.00, 0.00, 0.00 
RETURN 0 

10 SETI REIHE = REIHE + 1 
IF REIHE GT MAX. REIHE THEN 20 
SHIFT POSIT BY - 300.00, 50.00, 0,00 
SETI SPALTE = 1 
RETURN 0 
20 RETURN 1 

Die Position ANFANG ist im Teach-in-Verfahren bei Arbeitsbeginn zu definieren. 
Die Programmiersprache VAL ist Teil eines vollständigen Steuerungssystems, das über 
einen Monitor auch die interaktive Abarbeitung von Programmbefehlen und das Pro¬ 
grammtesten ermöglicht. Einfache Manipulatorsprachen lassen sich weitgehend inter- 
pretativ abarbeiten. Dabei erweist sich die Übersetzung der Eingabesprache in die Form 
einer virtuellen IR-Maschinensprache als vorteilhaft. Dieser Zwischenkode läßt sich so 
aufbauen, daß über einen Interpreter alle Grundfunktionen der Steuerung aufgerufen 
werden können. 


6.2.8. Höhere Programmiersprachen für Industrieroboter 

Wie bei der Rechnerprogrammierung, so ist man auch für Industrieroboter bemüht, 
höhere Programmiersprachen zu entwickeln, um die Arbeitsabläufe im technologischen 
Prozeß kürzer und mehr problemorientiert formulieren zu können. Während die ein¬ 
fachen Sprachen sich vorwiegend auf den Endeffektor beziehen, sind in höheren Manipu¬ 
latorsprachen auch Elemente zur Beschreibung von Objekten und darauf zugeschnittenen 
Operationen vorhanden. Die erste und bekannteste Sprache höheren Niveaus ist die 
Sprache AL [6.5] [6.21], die auch Grundlage für viele ähnliche Forschungsarbeiten ge¬ 
worden ist [6.17] [6.18] [6.19] [6.20]. 

Die Syntax von AL zeigt eine ALGOL-ähnliche Struktur. AL-Programme sind block¬ 
strukturiert. Alle im Programm verwendeten Variablen müssen definiert werden. Zur 
Dokumentation und Erläuterung können Bemerkungen in den Text eingefügt werden. 

Die grundlegenden Datentj^en sind: 

SCALAR Gleitkommazahlen (REAL) 

VECTOR Dreitupel zur Darstellung von Translationen, Geschwindigkeiten, Posi¬ 
tionen u.ä. 

ROT 3 X 3-Matrix zur Orientierungsangabe 



6.2. Programmierverfahren für Industrieroboter 


215 


FRAME lokales Koordinatensystem (Position und Orientierung relativ zum Basis¬ 
system WORLD) 

TRANS Transformationen von FRAMES und VECTOR (Aufbau wie FRAME). 

Alle algebraischen Datentypen lassen sich zu mehrdimensionalen Feldern (ARRAY) 
zusammenfassen. Einzelnen Variablen können physikalische Dimensionen zugeordnet 
werden (TIME, DISTANCE, ANGLE, FORCE, TORQUE, VELOCITY u.ä.). Neue 
Dimensionen werden durch Ausdrücke berechnet, z.B. VELOCITY VECTOR V; 
V xhat inches/sec. 

Durch Angabe eines AFFIX-Statements können Relationen zwischen einzelnen FRA¬ 
MES formuliert werden. Das hat zur Folge, daß z.B. durch AFFIX BOX TO ARM 
RIGIDLY ein fester Zusammenhang zwischen BOX und ARM entsteht und eine Be¬ 
wegung von BOX automatisch eine Bewegung von ARM bedeutet. Die Verbindung kann 
auch wieder gelöst werden durch UNFIX, wenn BOX z.B. abgesetzt wird. 

Zur Trajektorienbeschreibung wird das MOVE-Statement benutzt, das durch die An¬ 
gabe diverser Zusätze eine große Variabilität zuläßt. 

Die Bewegungspunkte müssen mit Hilfe einer interaktiven Teach-Komponente 
(POINTY) definiert werden. Die Grundform von MOVE bewegt ein FRAME zu einem 
Zielpunkt; 

MOVE frame TO ziel modifikation 


Als Modifikation sind folgende Angaben zulässig: 


VIA fl, f2, ... 

VIA f WHERE VELOCITY = v 
DURATION = u 

WITH DEPARTURE = exp 
WITH APPROACH = exp 
WITH FORCE = Scalar 
WITH TORQUE = Scalar 
WITH DURATION = Scalar 


Stützpunkte 

Stützpunkt mit Geschwindigkeits- und Zeitangabe 

definiertes Abfahren 
definiertes Annähern 
definierte Kraft 
definiertes Moment 
Verfahrzeit 


Durch Bedingungsmonitore lassen sich Trajektorien überwachen. Die Überwachung 
betrifft Kräfte, Momente, Zeitdauer und parallele Abläufe und läßt sich definiert an- und 
abschalten (ENABLE, DISABLE). Zur Steuerung des Effektors sind Elemente, die einen 
Greifer betreffen (OPEN, CLOSE, CENTER) und ein allgemeines Sprachelement für be¬ 
liebige Geräte definiert (OPERATE). Die Programmablaufsteuerung wird durch tradi¬ 
tionelle Kontrollstrukturen realisiert (IF, FOR, WHILE, UNTIL, CASE). Parallele Ab¬ 
läufe (Coroutinen), die durch COBEGIN und COEND gekennzeichnet sind, lassen sich 
durch SIGNAL und WAIT synchronisieren. Weitere Sprachelemente dienen der Pro¬ 
grammtestung und der Operatorkommunikation (PAUSE, PRINT, NOTE, DUMP). 

Neben Möglichkeiten der einfachen Bewegungsprogrammierung, die auch in einfachen 
Manipulatorsprachen vorhanden sind, zeichnen sich höhere Manipulatorsprachen durch 
Elemente zur strukturierten Programmierung aus. Die Zuordnung der höheren Mani¬ 
pulatorsprache zum Objektniveau des Programmiersystems ist darin begründet, daß z. B. 
durch AFFIX und UNFIX Objektrelationen ausgedrückt werden können und durch die 
Zuordnung von FRAMES zu Objekten und die Wahl eines geeigneten Objektnamens die 
Programmierung in bezug auf Objekte durchgeführt werden kann. 
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Das folgende Beispiel löst die Aufgabenstellung, fünf nebeneinanderliegende Quader 
zu einem Stapel zusammenzubauen. 

AL-Beispiel 

BEGIN „STAPELN“ 

FRAME POS, TURM, UEBERTURM 
POS ^ (START BEI 1. BLOCK) 

MOVE BARM TO PARK 
WITH DURATION = 5*SECONDS, 

TURM,^ FRAME (ROT(ZHAT, 180*DEGREES), 

VECTOR (0, 20, 0)*CM); 

FOR COUNT ^ 1 STEP 1 UNTIL 5 DO 
BEGIN „FOR“ 

OPEN HAND TO 10*CM 

MOVE BARM TO POS WITH APPROACH = 10*CM; 

CENTER BARM 

MOVE BARM TO TURM VIA UEBERTURM 
WITH DEPARTURE = 5*CM 
WITH APPROACH = 20*CM 
ON FORCE (ZHAT) > 10*GM DO STOP, 

POS POS + VECTOR (30, 0, 0)*CM, 

END „FOR“ 

END „STAPELN“ 

Bild 6.9 gibt eine Übersicht über die in einem AL-Programmiersystem realisierten Kom¬ 
ponenten [6.10] [6.18]. Im Unterschied zur ursprünglichen Version von AL [6.5] sind die 
Komponenten Compiler (AL-Standardmodus), Testsystem (ALAID) und interaktive 
Komponente (POINTY) in einem System zusammengefaßt und durch Modusauswahl 
ansprechbar. Außerdem ist die Trajektorienberechnung in die Ausführungszeit verlagert, 
um auf variable Umweltbedingungen besser reagieren zu können. 


6.3. Programmiersysteme von Industrierobotersteuerungen 

6.3.1. Grimdfimktionen eines Programmiersystems 

In diesem Kapitel werden die Funktionen des Programmiersystems und das Zusammen¬ 
wirken mit der Steuerung behandelt. Das Steuerungssystem realisiert Bewegungsabläufe 
gemäß einem vorgegebenen Programm und sorgt für das Zusammenspiel zwischen den 
Teilsystemen. Dabei sind die Operationen der Bewegungs-, Aktions- und Programm¬ 
ablaufsteuerung und ggf. der Verarbeitung von Sensorinformationen zu realisieren. Zur 
Programmierung stehen für diese Operationen relativ abgeschlossene funktionelle Mo- 
dule zur Verfügung. Sie gehören zur Grundausstattung des IR-Systems und werden in der 
Regel vom Hersteller der Steuerung mitgeliefert. Die Programmierung der Grundfunk¬ 
tionen erfolgt in interner Form und ist auf einen konkreten Roboter bzw. eine Klasse von 
ähnlichen Typen zugeschnitten. 

Das Programmiersystem muß es dem Anwender gestatten, alle Funktionen des Steue¬ 
rungssystems aufzurufen und in einer geeigneten Form das Bewegungs- und Aktionspro¬ 
gramm aufzustellen. Programmiersysteme können in Abhängigkeit von dem Leistungs¬ 
vermögen der Steuerung und dem Ausstattungsgrad mit Sensoren und Prozeßkoppel- 
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einrichtungen sehr unterschiedlich ausgebaut sein. Es lassen sich im wesentlichen folgende 
Funktionen unterscheiden: 


- Auslösen von Bewegungen; 

- Auslösen von Aktionen; 

- Programmtest und -korrektur; 

- Programmverwaltung (Erstellen, Editieren, Löschen, Archivieren); 

- Beschreibung der Verarbeitung von Daten über die Umwelt; 

- Beschreibung der Kommunikation mit anderen Steuerungssystemen; 

- Kommunikation mit dem Bediener (Menütechnik, Bedienerführung). 



Bild 6.9 

Übersicht über das Program¬ 
miersystem AL (nach [6.10]) 


6.3.2. Softwareentwicklung für Programmiersysteme 

Bei den bisher eingesetzten Programmierverfahren für Industrieroboter werden die Er¬ 
fahrungen der NC-Programmierung von Werkzeugmaschinen und der Anwendung von 
Teleoperatoren ausgenutzt. Unter Programmierung wird dabei nicht unbedingt die Auf- 
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Stellung eines lesbaren (textuellen) Programms verstanden, sondern vorrangig die Fest¬ 
legung eines Arbeitsablaufs in einem Speichermedium. 

Seit der Entwicklung von Programmiersprachen für Industrieroboter und ihrer Imple¬ 
mentierung auf Rechnersystemen zu Beginn der 70er Jahre ist die Notwendigkeit der 
Bereitstellung von komplexen Programmiersystemen für flexible Automatisierungslösun¬ 
gen bekannt (WAVE [6.4], AL [6.5], MAL [6.6]). An ihrer Realisierung wird intensiv 
gearbeitet, und zur Steuerung und Programmierung werden zunehmend leistungsfähige 
Softwaresysteme angeboten (z. B. VAL [6.7]). 

Für die Realisierung von komplexen Softwaresystemen besteht aus Zeit- und Kosten¬ 
gründen die Forderung nach effektiven Programmiermethoden. Einige Grundprinzipien 
sind dabei 

- Anwendung der strukturierten Programmierung mit den wesentlichen Kennzeichen der 
Modularität und der Portabilität der Programme, 

- klare Definition von Modulschnittstellen (Bereitstellung von flexibel einsetzbaren 
Lösungsvarianten mit gleichen Schnittstellen), 

- Generierbarkeit für angepaßte Lösungen (Modulauswahl), 

- Integrationsfähigkeit in übergeordnete Systeme, 

- Erweiterbarkeit des Funktionsumfangs, 

- Verwendung höherer Programmiersprachen (z. B. PASCAL). 

Bei Beachtung solcher grundlegenden Prinzipien ist die einmal für eine bestimmte 
Funktion erstellte Software in verschiedenen Systemen und auch bei Weiterentwicklung 
und Änderung der rechentechnischen Basis verfügbar, und unnötige Doppelarbeit wird 
vermieden. 

Die Nachteile der Anwendung höherer Programmiersprachen (größerer Speicher¬ 
bedarf und etwas längere Programmlaufzeiten) werden langfristig durch ständig sinkende 
Hardwarekosten für Speicherbausteine und Mikrorechnersysteme und durch die Wieder¬ 
verwendbarkeit von Programmodulen in verschiedenen Systemen ausgeglichen. In den 
folgenden Abschnitten werden die Grundgedanken der Modularität und hierarchischen 
Gestaltung ausführlicher behandelt. 


6.3.3. Modularer Aufbau von Steuerungssystemen 

Das IR-Steuerungssystem (oder einfach Steuerung) realisiert das Zusammenspiel zwi¬ 
schen allen Teilsystemen des IR. Der Nutzer des Systems sieht die Steuerung lediglich als 
ein Hilfsmittel an, das mit Hilfe des Programmiersystems erstellte Programm abarbeiten 
zu lassen. Die Steuerung definiert damit eine untere Schnittstelle für die Kommunikation 
mit dem IR. Die interne Bearbeitung erfolgt als ein vom Programm gesteuerter Aufruf 
von einzelnen Teilfunktionen (Operationen). 

Die im Abschnitt 6.3.2. genannten Grundforderungen der Modularität und Portabilität 
führen dazu, daß alle Teilfunktionen als relativ abgeschlossene Programmkomponenten 
(Module) mit einem genau definierten und im Vergleich zur Steuerungsaufgabe einge¬ 
schränkten Funktionsumfang realisiert werden. Diese Modularisierung bietet den Vor¬ 
teil, daß überschaubare Programmteile entstehen, die bei Bedarf durch andere (neue Ver¬ 
sionen oder vom Robotertyp abhängige Varianten) ausgetauscht werden können. Die 
Modularisierung zwingt auch zur Definition von Modulschnittstellen. Sind z. B. die Kom¬ 
ponenten Achsregelung, Effektorsteuerung und Sensorsystem mit genormten Schnitt¬ 
stellen ausgerüstet, so lassen sich IR-Steuerungen generieren, bei denen Komponenten 
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unterschiedlicher Produzenten zusammengeschaltet werden können und die eigentliche 
Steuerungssoftware multivalent genutzt werden kann. 

Da die Anforderungen an das Steuerprogramm System sehr stark vom Einsatz des Ro¬ 
boters abhängig sind, kommt (besonders bei prozeßflexiblen Anwendungsfällen) der 
Bereitstellung eines modular aufgebauten, auf ein bestimmtes Einsatzgebiet und einen 
konkreten Roboter abstimmbaren Steuerungssystems (Generierbarkeit) eine wachsende 
Bedeutung zu. 


L 


Programm 


Daten 






(CAD) 


Sprach- 


Objekt- 

Übersetzer 


modetlierung 



Bild 6.10. Grundstruktur eines modularen Steuerungs- und Programmiersystems 


Die funktionelle Grundstruktur einer modularen IR-Steuerung, deren Programmie¬ 
rung im externen Koordinatensystem erfolgen kann, ist im Bild 6.10 dargestellt. Der Um¬ 
fang der in den einzelnen Komponenten realisierten Algorithmen bestimmt die Leistungs¬ 
fähigkeit der Steuerung. So kann z. B. die Koordinatentransformation für drei Freiheits¬ 
grade (Position mit x, y, z) oder auch für sechs Freiheitsgrade (Position und Orientierung) 
realisiert sein. Die Berücksichtigung der Orientierung gestattet bei der zweiten Variante 
eine wesentliche einfachere Programmierung. 
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6.3.4. Hierarchische Gestaltung von Programmiersystemen 

Die Integration von Industrierobotern in rechnergesteuerte Fertigungssysteme und der 
rechnergestützte Entwurf von Erzeugnissen (CAD computer-öided ^/esign) machen den 
Einsatz hierarchisch aufgebauter Programmiersysteme mit zunehmender Komplexität 
möglich und notwendig. Die für den Industrieroboter erforderlichen Komponenten in 
einem solchen komplexen Programmier- und Steuerungssystem für zukünftige Ferti¬ 
gungsabschnitte sind im Bild 6.11 dargestellt. 



Fertigungs¬ 
ebene (^) 


Aufgaben- 
ebene (3} 


Objekt- 
ebene 12} 


Manipulator- 
ebene (1) 


Basis - 
ebene (0) 

Software 


Basis - 

ebene 10} 


Hardware 


Bild 6.11 

Hierarchieebenen der 
Industrieroboterprogrammierung 
in Fertigungssystemen 


In der Ebene der Fertigungssteuerung ist der IR lediglich Teil einer komplexen Auto¬ 
matisierungsanlage und wird im Fertigungsprogramm als eine programmierbare Kompo¬ 
nente mit bestimmten funktionellen Möglichkeiten angesehen. Die Aufgaben Verteilung 
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realisiert ein Maschinenbelegungsprogramm, das die momentane Verfügbarkeit sowie 
bestimmte Optimierungskriterien des Fertigungsablaufs berücksichtigt. Die benötigten 
Objektdaten werden direkt aus einer CAD-Datei gewonnen. 

Die Aufgabenebene erzeugt aus einer problemorientierten Aufgabenformulierung ein 
IR-Programm auf dem Objektniveau. Die Aufgabe des Programmiersystems besteht auf 
diesem Niveau darin, durch Nutzung von Wissen über den technologischen Prozeß eine 
geeignete Ablauffolge in Form einer Objekt- und Handlungsbeschreibung in der höheren 
Manipulatorsprache zu erzeugen. Für einfache Aufgabenstellungen ist zur automatischen 
Handlungsplangenerierung ein System von vorgefertigten Makrobausteinen ausreichend, 
die für konkrete Fälle zu einem Programm zusammengefügt werden. Bei komplexeren 
Aufgabenstellungen werden Verfahren der künstlichen Intelligenz (z. B. Problemlöser) 
eingesetzt, die aus einer sehr kurzen Aufgabenformulierung ein komplettes Programm 
aufstellen können. 

Die Objektebene realisiert die Umsetzung des IR-Programms in Form einer Objekt- 
und Aktionsbeschreibung in ein Programm zur Beschreibung von IR-Funktionen. Dabei 
sind die konkreten Umweltrestriktionen anhand eines Umweltmodells zu berücksichti¬ 
gen. Durch ein ausgebautes Simulationssystem lassen sich auch die geometrischen Ab¬ 
messungen des Manipulators und dessen dynamisches Verhalten einbeziehen. Das ent¬ 
stehende Programm ist damit vom konkreten Robotertyp abhängig. 

Auf der Manipulator ebene wird für jede IR-Funktion ein Aufruf von Komponenten 
des Steuerungssystems realisiert. Diese Ebene stellt als virtuelle Maschine die Verbindung 
des Programmiersystems mit dem Steuerungssystem dar. Bezüglich des Programmier¬ 
systems lassen sich alle Funktionen des Steuerungssystems, des Betriebssystems und der 
Hardware in einer Basisebene zusammenfassen, die sich für den Anwender als nicht frei 
programmierbar darstellt. 

Werden Industrieroboter im technologischen Fertigungsprozeß eingesetzt, erfüllen sie 
eine spezielle Teilaufgabe in einem komplexen Zusammenhang. In jeder der Hierarchie¬ 
ebenen findet eine Aufgabendekomposition in eine überschaubare Anzahl von Operationen 
statt. Diese hierarchische Aufgabendekomposition wird in ein hierarchisches Program¬ 
miersystem übertragen, um den Zugriff auf die unterschiedlichen Ebenen zu gewähr¬ 
leisten. Da die Komplexität der Aufgaben mit steigendem Abstraktionsgrad zunimmt, ist 
zur Realisierung des Programmiersystems ein Rechnersystem erforderlich [6.2]. Die Pro¬ 
grammierung des IR erfolgt dabei z. B. auf einem Kleinrechner (Programmentwicklung) 
und die Programmabarbeitung (Steuerung) auf einem Mikrorechnersystem. 
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Sensoren 


Die für einen Handlungszyklus des Industrieroboters erforderlichen Bewegungsdaten 
können auf drei unterschiedliche Arten gewonnen werden: 

- durch direktes oder indirektes Teach-in, wobei der Roboter selbst oder ein geeignetes 

Hilfsgerät zur Digitalisierung von Raumpunkten benutzt wird; 

- aus einem einmal erstellten Umweltmodell durch Off-line-Programmierung, wobei die 

Bewegungsdaten anhand eines Datenspeichers gewonnen werden; 

- durch ein Grobmodell der Umwelt, das durch äußere Sensoren vervollständigt und 

aktualisiert wird. 

Die ersten beiden Methoden setzen voraus, daß das der Datengewinnung zugrunde ge¬ 
legte Umweltmodell statisch ist oder sich nur in determinierter Weise ändert. 

Hieraus resultieren erhebliche Genauigkeitsforderungen an den technologischen Ab¬ 
lauf, die im wesentlichen in der Herstellung exakt reproduzierbarer Zustände durch peri¬ 
phere Einrichtungen (Paletten, Fördergeräte, Spanntische) bestehen. Eine Veränderung 
der Arbeitsaufgabe ist dabei in der Regel mit aufwendigen mechanischen Umrüstungen, 
Justierung und Erstellung neuer Bewegungsprogramme verbunden. 

Mit steigenden Forderungen an die Genauigkeit wächst der Aufwand für Roboter, 
periphere Einrichtungen und Programmierung erheblich. 

Daneben gibt es zahlreiche technologische Prozesse, bei denen Werkstücktoleranzen, 
indeterminierte Positionen und unbekannte Werkstücksequenzen auftreten, die den Ein¬ 
satz von Industrierobotern mit festprogrammierten Bewegungsdaten ausschließen. 

Durch die Entwicklung und Anwendung adaptiver Robotersysteme können die Forde¬ 
rungen an die Genauigkeit und die Arbeitsvorbereitung herabgesetzt und effektive Ein¬ 
satzmöglichkeiten im Bereich kleinerer Losgrößen geschaffen werden. 

Adaption bedeutet in diesem Zusammenhang, daß anhand eines groben Umwelt¬ 
modells Abläufe und Bewegungsdaten programmiert und aktuell auftretende Zustands¬ 
änderungen zur Korrektur des programmierten Ablaufs herangezogen werden. Die Ände¬ 
rung der Umweltparameter wird dabei durch Sensoren erfaßt. 

Diese Sensoren werden im Gegensatz zu den inneren Meßsystemen des IR, die den Zu¬ 
stand des kinematischen Systems erfassen, als äußere Sensoren bezeichnet. 

Äußere Sensoren sind dabei nicht nur zur Erfassung von Prozeßparametern in der 
Arbeitsphase, sondern auch zur Vereinfachung des Teach-in (Kollisionsverhütung, Genau¬ 
positionieren) und zur Gewinnung konstanter Umweltparameter (Modellbildung) ge¬ 
eignet. Äußere Sensoren können aber auch bei relativ einfachen Steuerungsaufgaben ent¬ 
scheidend zur Verbesserung der Einsatzparameter beitragen oder einige Einsatzgebiete 
überhaupt erst ermöglichen. 

In diesem Abschnitt sollen anhand ausgewählter Beispiele die Wirkprinzipien äußerer 
Sensorsysteme, ihre potentiellen Einsatzmöglichkeiten und die Entwicklungstendenzen 
dargestellt werden. 
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7.1. Äußere Sensoren und Steuerungsfunktionen 

Sensoren dienen der Erfassung relevanter physikalischer Größen im Arbeitsbereich des 
Industrieroboters, um ihn gemäß der gestellten Aufgabe zu einer sinnvollen Reaktion auf 
Veränderungen im Arbeitsraum zu befähigen. Eine Übersicht zu den erforderlichen Meß¬ 
aufgaben bei unterschiedlichen Aktionen des Roboters gibt Tafel 7.1. 


Tafel 7.1. Meßaufgaben von Sensorsystemen bei einigen IR-Operationen 


Operation des IR 

Punkt-zu-Punkt-Bewegung 

Meßaufgabe 

Erfassung von Hindernissen (Kollisionsschutz) 
Messung der Zielkoordinaten zum Genaupositionieren 

Greifen definierter Objekte 
mit Positionsabweichung 

Anwesenheit des Objektes 

Zentrieren des Greifers in der Greifebene 

Greifen zerbrechlicher Objekte 

Messung der Greifkräfte 

Bewegung auf technologisch 
bedingten Bahnen 

Messung toleranzbedingter Abweichungen 
von Referenzbahnen 
absolute Bahnvermessung 

Kraftschlüssige technologische Operationen 
(Fügen, Schleifen, Polieren) 

Messung der ausgeübten Kräfte oder Reaktionskräfte 

Greifen Undefinierter Objekte 

Erkennung und Klassifizierung 

Lagebestimmung 

Bewegung in Undefiniertem oder zeitlich 
variablem Arbeitsraum 

Erkennung und Klassifizierung von Objekten 
und Relationen zwischen Objekten 


Dabei ist zu unterscheiden zwischen Aufgaben, die auch ohne Sensoren prinzipiell lös¬ 
bar sind, wo durch ihren Einsatz aber Zeiteinsparung bei der Programmierung oder eine 
Herabsetzung der Forderungen an die Genauigkeit der Peripherie möglich ist, und solchen 
Aufgaben, die ohne Sensoren nicht durchführbar sind. Zu der zweiten Klasse von Auf¬ 
gaben rechnen insbesondere Fügevorgänge, für die die Wiederholgenauigkeit der In¬ 
dustrieroboter beim Positionieren nicht ausreichend ist oder Toleranzen beim Fügen zu 
berücksichtigen sind. Beim Lichtbogenschweißen werden in der Regel nur geringe Forde¬ 
rungen an die Genauigkeit der Werkstücke gestellt; die Notwendigkeit des Einsatzes von 
Sensoren resultiert in erster Linie aus der Führung des Schweißprozesses selbst und dem 
damit verbundenen thermischen Versatz. 

Typisch für Industrierobotersensoren ist, daß aufgrund der Bewegungsmöglichkeiten 
und des Vorhandenseins eines inneren Meßsystems die benötigten Informationen auf sehr 
unterschiedliche Weise gewonnen werden können. Positionen von Werkstücken im Ar¬ 
beitsraum können beispielsweise durch taktilen Kontakt des Effektors mit dem Werkstück 
und Auswertung der Lagemeßwerte des kinematischen Systems, durch Messung relevan¬ 
ter Distanzen zwischen Effektor und Werkstück oder durch Auswertung des mittels eines 
Erkennungssystems gewonnenen Abbilds des Arbeitsraums gewonnen werden. 

Hinzu kommt, daß die Umwelt des Industrieroboters als Teil eines technologischen 
Gesamtprozesses in weiten Grenzen gestaltbar ist. Markierungen an Werkstücken, die ihre 
Funktion nicht beeinträchtigen, können beispielsweise sehr effektiv zur Unterscheidung 
verschiedener Werkstücke mit sehr einfachen Sensoren dienen. 
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Äußere Sensoren müssen die benötigte Information in einer von der Steuerung ver¬ 
arbeitbaren Form liefern. Die möglichen funktionellen Schnittstellen zur Steuerung sind 
im Bild 7.1 dargestellt. Der direkte Zugriff auf die Lageregler gestattet die kürzesten 
Reaktionszeiten und ist somit besonders zur Kollisionsverhütung und zum Überlast¬ 
schutz geeignet. Liegen die Meßwerte in den Koordinaten der einzelnen Achsen vor, läßt 
sich deren Bewegungsverlauf durch Einspeisung in die vor der Gelenkinterpolation lie¬ 
gende Schnittstelle 2 beeinflussen. Korrekturen des Bahnverlaufs und der Geschwindigkeit 
müssen vor der inversen Koordinatentransformation (Schnittstelle 3) vorgenommen wer¬ 
den. Die Schnittstelle 4 gestattet die Auswahl unterschiedlicher Bahnend- und Zwischen¬ 
punkte und Bahnsegmente. Durch die Schnittstelle 5 werden unterschiedliche Bewegungs¬ 
programme aus dem Arbeitsspeicher ausgewählt. 


Trajektonen- 
planung u. 
Interpo/af/on 


^gramm\ 

spdchef\ 



mverse 
Koordinafet 
fransformat. 



Gelenk- 
Inferpolafor 



Lageregel¬ 

kreise 


Bild 7.1. Funktionelle Schnittstellen zur adaptiven Steuerung von Industrierobotern 


Die Sensorinformationen lassen sich grob unterteilen in 

- Bestimmung der Anwesenheit von Objekten oder Objektteilen in einem gegebenen Be¬ 
reich, 

- Bestimmung räumlicher Relationen zwischen Effektor und Werkstück oder zwischen 
Objekten bzw. Objektteilen, 

- Messung von Wechselwirkungskräften zwischen Industrieroboter und Umwelt, 

- Identifikation von Werkstücken oder Teilen von Werkstücken. 

Hinzu kommen weitere Meßaufgaben zur Funktionssicherung, Diagnose, Bestimmung 
von Qualitätsparametern usw., die nicht roboterspezifisch sind und die bei allen Automa¬ 
tisierungsaufgaben in ähnlicher Weise zu lösen sind. 

Für jede der Meßaufgaben sind mehrere Meßprinzipien und unterschiedliche Primär¬ 
wandler verwendbar. Ihre Eignung hängt dabei wesentlich von den technologischen Rand¬ 
bedingungen und den konkreten Störeinflüssen ab. 

Nach der Art der Informationsgewinnung werden äußere Sensoren für Industrieroboter 
in 

- taktile Sensoren, 

- Näherungssensoren und 

- Erkennungssysteme 

eingeteilt. 

Bei den Sensoren unterscheidet man außerdem solche, die eine skalare Größe, eine 
vektorielle Größe oder skalare bzw. vektorielle Größen in ein bis drei Dimensionen auf¬ 
nehmen. Je komplexer die aufgenommene Information ist, um so aufwendiger wird einer¬ 
seits die zur Ableitung der Steuerungsgröße benötigte Informationsgewinnung, um so 
flexibler lassen sich aber andererseits die Sensoren für unterschiedliche Aufgaben ein- 
setzen. 
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Eine besondere Bedeutung kommt dabei den visuellen Erkennungssystemen zu, da mit 
ihnen ganze Umweltausschnitte mit hoher Auflösung erfaßt werden können. 

Ähnliche Forderungen werden zukünftig auch taktile Matrixsensoren zu erfüllen 
haben, die aus dem formschlüssigen Kontakt Werkstücke identifizieren und deren Lage im 
Greifersystem ermitteln müssen. Sie werden insbesondere dann eingesetzt, wenn die Be¬ 
dingungen für den Einsatz visueller Erkennungssysteme nicht gegeben sind, z. B. da 
Werkstückteile durch den Greifer verdeckt sind oder keine ausreichende Beleuchtung mög¬ 
lich ist. 

Um die Informationen aus dem unmittelbaren Arbeitsbereich des Industrieroboters zu 
erfassen, ist eine Anbringung in unmittelbarer Nähe des Effektors erforderlich. Dies ist 
auch eine wichtige Voraussetzung für ihren flexiblen Einsatz [7.1]. Um eine störsichere 
Übertragung in die Steuerung zu gewährleisten, ist dabei eine Vorverarbeitung und Ver¬ 
dichtung der von den Primärwandlern gelieferten Signale vorzunehmen. 


7.2. Taktile Sensoren 

Mit Hilfe berührender Sensoren werden zwei Arten von Informationen gewonnen, die 
sich in ihrer Qualität unterscheiden. Erstens werden durch Herstellung eines Kontakts 
zwischen einem Meßfühler und einem zu vermessenden Objekt Informationen über die 
Anwesenheit und die Form des Objekts gewonnen; die Wechselwirkung zwischen Objekt 
und Meßfühler wird dabei so gering wie möglich gehalten. Zweitens werden taktile Sen¬ 
soren zur Messung der Kräfte und Momente eingesetzt, die bei der Wechselwirkung des 
Roboters mit dem zu hantierenden oder zu bearbeitenden Objekt auftreten. Da die direkte 
Messung von Kräften nicht möglich ist, erfolgt in beiden Fällen die Messung von Längen¬ 
änderungen eines deformierbaren Körpers. 


7.2.1. Taktile Meßfühler 


Das Prinzip taktiler Meßfühler ist im Bild 7.2 dargestellt. Ein elastisch aufgehängter 
Tastfinger wird bei Kontakt mit einem Objekt ausgelenkt. Die Meßwandler können ent¬ 
weder als Kontaktschalter oder als Distanzwandler ausgeführt sein; man unterscheidet 
danach schaltende und messende Tastsensoren. 


Federn 



Bild 7.2 

Taktiler Meßfühler 


Schaltende Tastsensoren mit einem Schaltbereich von einigen zehntein Millimetern 
werden in Verbindung mit dem inneren Meßsystem des IR zur groben Vermessung von 
Objektflächen, Konturverfolgung und Abstandsführung (z.B. beim Schweißen) einge¬ 
setzt. 

Durch Kombination eines hochauflösenden inneren Meßsystems mit einem messenden 
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Bild 7.3. Meßroboter zur Bestimmung von Formabweichungen bei Autokarrosserien (Werkfoto Prima 
Prägetti Spa, Turin) 


Tastfühler entstehen Meßroboter oder Mehrkoordinatenmeßsysteme (Bild 7.3). Dabei 
werden durch definierte Bewegungen des kinematischen Systems Kontaktpunkte mit dem 
Objekt ermittelt, deren Positionen mit Referenzdaten verglichen werden. Die eingesetz¬ 
ten Tastsensoren messen dabei in bis zu drei Koordinatenachsen. Als Wegaufnehmer 
finden induktive Meßwandler Verwendung. 


7.2.2. Kraft-Moment-Sensoren 

Die Erfassung äußerer Kräfte und Drehmomente ist zur definierten Steuerung der Reak¬ 
tionskräfte bei Montageaufgaben, Bearbeitungsverfahren wie Gußputzen, Entgraten, 
Polieren sowie zur Überlasterkennung und Schadensverhütung bei Kollisionen notwen¬ 
dig. Bewegungsbahnen und -geschwindigkeiten sind dabei durch die gemessenen Kräfte 
und Momente so zu adaptieren, daß vorgegebene Reaktionskräfte eingehalten werden. In 
den genannten Einsatzgebieten treten gegenüber dem beim Programmieren vorliegenden 
Umweltmodell durch Werkstücktoleranzen, Aufspannabweichungen, Werkzeugverschleiß 
und technologisch bedingte stochastische Konturverläufe (z. B. Angußreste, Grat) Ab¬ 
weichungen auf, die in der Bearbeitungsphase zu berücksichtigen sind. Im einzelnen wer¬ 
den durch die Nutzung von Kraft-Moment-Messungen zur Steuerung des Industrierobo¬ 
ters folgende Einsatzgebiete erschlossen: 

Fügen und Montieren 

Die zu fügenden Teile sind so zu positionieren, daß keine Verklemmung auftritt; die 
Fügekraft ist zu regeln; toleranzbedingte Überlastung ist zu vermeiden. (Auf die für spe¬ 
zielle Anwendungsfälle entwickelten, passiven und selbstjustierenden Fügemechanismen 
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wird im folgenden nicht eingegangen; hier sei auf ausführliche Beschreibungen in [7.3] 
[7.4] verwiesen.) 

Schleifen und Entgraten 

Die Arbeitsgeschwindigkeit des Industrieroboters ist so zu regeln, daß er im Bereich seiner 
eigenen Nennbelastung bzw. der des Werkzeugs arbeitet. Toleranzbedingte Bahnabwei¬ 
chungen und Werkzeugverschleiß sind auszugleichen. 

Beschicken 

Regelung von Greifkräften bei zerbrechlichen Gegenständen, Erkennen von Überlastun¬ 
gen bei Kollision oder Klemmen von Werkstücken. 

Prinzipiell sind drei Varianten der Kraft- und Momentmessung möglich: 

- Ermittlung über die Antriebsrückwirkung, 

- Erfassung mit Sensoren in einem Bearbeitungstisch, 

- Erfassung mit Sensoren am Handgelenk in der Nähe des Werkzeugs oder Greifers. 

Die erste Möglichkeit hat sich als zu ungenau erwiesen, da in die Transformations¬ 
beziehungen zur Kraftgrößenermittlung am Kraftangriffspunkt das gesamte Roboter¬ 
modell einschließlich der Antriebscharakteristik und nichterfaßbarer Reibungen ein¬ 
fließen. 

Eine Ausnahme bildet die Bearbeitung von Werkstücken durch Entgraten, wenn das 
Werkstück vom Roboter an der Schleifmaschine geführt wird. Die Messung der Lei¬ 
stungsaufnahme der Schleifeinrichtung kann hier grob zur Steuerung der Verfahr¬ 
geschwindigkeit genutzt werden. 

Die Messung der Kräfte und Momente im Bearbeitungstisch führt in der Regel zu spe¬ 
ziellen Peripherielösungen und erfordert hohen Umrüstaufwand bei veränderten Auf¬ 
gaben. 

International durchgesetzt haben sich aus diesen Gründen Sensoren, die in den Robo¬ 
ter integriert werden können und damit die flexibelsten Einsatzmöglichkeiten gestatten. 

Die adaptive Bewegungssteuerung eines Roboters mit fünf und mehr Freiheitsgraden 
erfordert die Messung aller sechs mechanischen Schnittgrößen im Koordinatensystem 
des Effektors. 

Mechanische Schnittgrößen (Kräfte, Momente) werden durch Einstellung eines Gleich¬ 
gewichtszustands mit einer der Schnittgröße entgegengerichteten Kraft- oder Momenten- 
größe ermittelt. Diese Gegenschnittgröße wird in der Regel durch Deformation eines 
elastischen Verformungskörpers erzeugt. Die Größe der Verformung dient bei entspre¬ 
chender Eichung als Maß für die Schnittgröße. Man unterscheidet elektrisch aktive und 
elektrisch inaktive Verformkörper. Bei elektrisch inaktiven Verformkörpern wird die 
Deformation durch Dehnungsmessung oder Distanzmessung ermittelt. Beide Prinzipien 
sind im Bild 7.4 am Beispiel der Greifkraftmessung dargestellt. 

Dabei wird der lineare Zusammenhang zwischen Kraft und Deformation genutzt 
(Hookesches Gesetz). 

Beide Meßmethoden werden auch bei der Konstruktion von 6-Komponenten-Sensoren 
angewendet. 

Da es schwierig und mechanisch zu aufwendig ist, für jede Kraft- oder Momentkompo¬ 
nente einen separaten Verformkörper zu installieren und ihre Angriffspunkte so zu ge¬ 
stalten, daß die Schnittkräfte in einem gemeinsamen Koordinatensystem gemessen wer¬ 
den, sind Verformkörper so konstruiert, daß nicht die Kraft- und Momentkomponenten 
direkt, sondern Linearkombinationen der einzelnen Beiträge bestimmt werden. 
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Ein Beispiel hierzu wird im Bild 7.5 gezeigt. Der Verformkörper enthält acht Biege¬ 
stäbe {Px, , P^, P^, Qx,Qx’ Qy>Qy \ denen je zwei Dehnmeßstreifen angebracht 
sind. Das Dehnmeßstreifenpaar ist Bestandteil einer temperaturkompensierten Meß¬ 
brücke, die ein verformungsanaloges Ausgangssignal liefert. 

U;; 




Bild 7.4. Prinzip der Deformationsmessung mit Bild 7.5. Verformkörper mit acht Dehnmeß- 

Distanzwandler und Dehnmeßstreifen streifenpaaren zur Kraft- undMomentenmessung 


Für den Zusammenhang zwischen den Ausgangsspannungen der Aufnehmer und den 
Kraft-Moment-Komponenten, bezogen auf ein festes Koordinatensystem im Verform¬ 
körper, gilt 


oder 


Ul = Ciifx + Ci2fy -h C,-3/z + Ct^nix -h Cistriy -f- 
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fy 

/z 
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niy 
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00 

^86 


= CF. 


(7.1) 


C ist die sog. Koppelmatrix; ihre Elemente werden in der Regel durch definierte Kräfte 
und Momente in den Koordinatenachsen ermittelt. Zur Berechnung der Kräfte ist ent¬ 
sprechend 


F=C-W (7.2) 

die Inverse der Koppelmatrix zu bilden. Da die Inverse nur für quadratische Matrizen ge¬ 
bildet werden kann, gilt hier 

F = (C^C)"‘ = CW (7.3) 

mit C' als Pseudoinverse. 

Die Invertierbarkeit der Matrizen C bzw. C^C ist nur gesichert, wenn die Anordnung 
der Meßwandler und der meßtechnisch aktiven Verformkörperteile so gewählt ist, daß die 
Ausgangssignale linear unabhängig sind. 

Wird die Anordnung und Gestaltung der meßtechnisch aktiven Zonen und der Meß¬ 
wandler so gewählt, daß eine direkte Zuordnung zwischen einer Kraftgrößenkomponente 
und einem einzigen elektrischen Ausgangssignal erzielt wird, ist C eine Diagonalmatrix. 
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Bei der einfachen und preiswerten Gestaltung von mehrkomponentigen Sensoren werden 
zwei Wege beschritten. Der erste besteht darin, den Verformkörper so einfach wie mög¬ 
lich zu gestalten und die zahlreichen auftretenden Verkopplungen durch erhöhten Re¬ 
chenaufwand bei der Dekomposition der Komponenten zu berücksichtigen. Ein Beispiel 
wird im Bild 7.6 gezeigt. An den drei meßtechnisch aktiven Stegen sind je zwei Dehn¬ 
meßstreifenpaare angeordnet; jedes Paar mißt eine Längsdehnung oder Scherkraft. 



Bild 7.6 

Verformkörper mit drei Stegen (nach [7.9]) 


Nachteilig wirkt sich dabei aus, daß für die Verformung Vorzugsrichtungen auftreten, in 
denen der Verformkörper bei gleicher Kraft unterschiedlich stark deformiert wird. 

Der zweite Weg besteht in der Konstruktion von Verformkörpern, bei denen die Ent¬ 
kopplungsmatrix C möglichst viele Nullelemente besitzt. Dies kann durch zusätzliche 
Verformelemente geschehen; das Prinzip ist im Bild 7.7 dargestellt [7.5]. 



Werkzeug, Greifer 



Bild 7.7. a) Prinzip der mechanischen Entkopplung von Verformelementen und b) Anordnung der 
Entkopplungsstäbe im Kraft-Momenten-Sensor 


Unterschiedliche Vorspannungen der Verformteile und Eigengewicht von Sensor- und 
Effektorteilen führen zu zusätzlichen additiven Komponenten des Ausgangsspannungs¬ 
vektors U, der bei der Auswertung gemäß 

F = C\U - B) (7.4) 

zu berücksichtigen ist. 

Der Biasvektor B faßt alle additiven Übertragungsfehler zusammen und kann zur 
Unterdrückung unerwünschter konstanter Kräfte durch Eichung ermittelt werden. Ein 
Beispiel für die Ausführung von Kraft-Moment-Sensoren mit Abstandsmeßwandlern 
wird im Bild 7.8 gezeigt. Das Innenteil der Meßdose ist durch Federn so mit dem Außen¬ 
ring verbunden, daß es in allen Richtungen beweglich ist und möglichst richtungsunab- 
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hängige Gegenkräfte überträgt. Die Meßwandler 1 bis 3 sind in unterschiedlichem Win¬ 
kel zum Boden des Außenrings angebracht, damit linear unabhängige Meßgrößen erfaßt 
werden. 

Als Meßwandler kommen induktive, kapazitive oder optoelektronische Wandler 
(s. Abschn. 7.3.) in Frage, wobei eine Zwischenübertragung durch mechanische Stifte vor¬ 
genommen wird. 


Bild 7.8 

Kraft-Moment-Sensor mit 
sechs Distanzwandlern 
(nach [7.8]) 

Wichtige Kenngrößen für Kraft-Moment-Meßeinrichtungen sind 

- Verformung bei Nennkraft - sie sollte 0,1 bis 0,2 mm nicht überschreiten, da sie die 
Positioniergenauigkeit der vor der Dose liegenden Greifer oder Werkzeuge beeinflußt; 

- Überlastsicherheit - Kräfte bis zum lOfachen der Nennlast dürfen den Verformkörper 
nicht zerstören; dies kann durch mechanische Anschläge erreicht werden, damit sind 
die Meßwandler geschützt; 

- geringe Hysterese des Verformteils; 

- geringe Eigenmasse. 

Im Bild 7.9 ist die Struktur der Signalverarbeitung für einen Kraft-Moment-Sensor mit 
sechs Dehnmeßstreifenbrücken als Primärwandler dargestellt. 

Die Brückenausgangssignale werden nach der Vorverstärkung tiefpaßgefiltert, um Ein¬ 
flüsse von Materialschwingungen im Verformkörper und im mechanischen Teil des Indu¬ 
strieroboters zu eliminieren. Für den erforderlichen Genauigkeitsbereich und die Auflösung 
der Primärwandler ist in der Regel eine A/D-Wandlung in 100 Amplitudenstufen aus¬ 
reichend; das entspricht mit Vorzeichen 8 Bit. Nach jedem Einlesen eines Meßwerts wird 
zunächst ein Überlasttest durchgeführt. Wird ein vorgegebener Grenzwert überschrit¬ 
ten, erfolgt sofort eine Interruptmeldung, die über einen speziellen Ausgang in den Steuer¬ 
rechner gelangt und zum sofortigen Stop der Antriebe genutzt werden kann. In einem 
weiteren Digitalfilter, das programmtechnisch realisiert ist, wird die für spezifische Auf¬ 
gaben benötigte Tiefpaßcharakteristik programmiert. Nach Subtraktion des Biasvektors 
erfolgt die Entkopplung. Anschließend wird mit einem Kalibrierprogramm der Kraft- 
Moment-Vektor in das Effektorkoordinatensystem umgerechnet. 

Wegen des hohen Anteils der Multiplikationen (in der Entkopplungsmatrix bis zu 48) 
wird zur Echtzeitverarbeitung häufig ein spezieller Arithmetikprozessor eingesetzt. Da¬ 
mit sind Verarbeitungszeiten für einen vollständigen Kraft-Moment-Vektor von 10 ms 
erreichbar. 

Kraft-Moment-Sensoren werden für unterschiedliche Nennbelastung industriell ge¬ 
fertigt, z.T. mit vollständiger Vorverarbeitung und Mikrorechner innerhalb der Meßdose 
[7.6]. Im Bild 7.10 ist der Einsatz eines Kraft-Moment-Sensors beim Schleifen von An¬ 
gußresten schematisch dargestellt. Zur Erzielung einer maximalen Arbeitsgeschwindigkeit 
ist die Verfahrgeschwindigkeit des IR so zu regeln, daß die Schleifkraft P, die sich aus 
drei Komponenten zusammensetzt - die zur Schleifscheibe tangentiale Komponente ist 
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nicht eingezeichnet einen möglichst konstanten Wert hat. Durch die Werkstücktoleran¬ 
zen und den Schleifkörperabrieb ist außerdem eine Trajektorienanpassung in x-Richtung 
notwendig. Ist die Gratabmessung in der z-Richtung wesentlich kleiner als der Schleif¬ 
scheibendurchmesser, so ist eine gleichzeitige Adaption der Trajektorie und der Verfahr¬ 
geschwindigkeit möglich, da die Kräfteänderungen durch Abrieb und Toleranz wesent¬ 
lich langsamer verlaufen als die durch den Grat bewirkten Änderungen [7.7]. 

ln der Montage werden Kraft-Moment-Sensoren eingesetzt, um das Verklemmen von 




E~( , fyg , fzg, ^xg / '’^xg ^zg ^ 

b) 


Bild 7.9 

Informationsverarbeitung für einen Kraft-Moment-Sensor 
mit sechs Dehnmeßstreifenbrücken 
a) Hardwarestruktur; b) Programmablauf 



programmierte Trajektorie bei 
Trajektorie Toleranzabweichung 


Bild 7.10 

Vorschubregelung und Trajektorienan¬ 
passung beim Schleifen 
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Fügeteilen beim Justieren durch eine Gegenbewegung aufzuheben und die Fügekraft zu 
regeln. 

Werden die hierzu erforderlichen Bewegungsgenauigkeiten vom IR nicht gewährleistet, 
kommen zur Justage spezielle Montagehilfseinrichtungen zur Anwendung, die sehr prä¬ 
zise Ausgleichsbewegungen durchführen [7.3]. 


7.2.3. Taktile Matrixsensoren 

Zur groben Form- und Lageerkennung können matrixförmig angeordnete binäre oder 
analoge Berührungssensoren in den Greifflächen von Industrierobotern eingesetzt werden. 
Die einfachste Lösung besteht aus einem Rasterfeld von Druckschaltern. 


(eitende Folie 
Hunstoff, 
bei Druck 
elekrisch leitend 
eingegossene 
Stifte 

Leiterplatte 


tone 


bewegliche Stifte 
Rasterplatte 



^12V OV 


Bild 7.11 

Taktile Matrix mit beweg¬ 
lichen Stiften 




b) 




Bild 7.12. Taktile Matrix (nach [7.10]) 

a) Wandlungsprinzip; b) Übertragungskennlinie; c) geometrische Anordnung; d) Abtastung und Signalvorverarbeitung 
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Bild 7.11 zeigt ein Beispiel für eine analog arbeitende Druckmatrix. Bewegliche Stifte 
drücken bei Werkstückkontakt eine leitende Folie auf eine Kunststoffolie, wobei der 
Übergangswiderstand zwischen der leitenden Folie und den eingegossenen Stiften stark 
verringert wird. Die Auskopplung der einzelnen Signale kann über Optokoppler erfolgen. 
Die prinzipiellen Verfahren zur Auswertung solcher Matrixinformationen sind mit den 
Methoden der visuellen 2-D-Erkennung, die im Abschnitt 7.4. erläutert werden, identisch 
und sollen hier nicht behandelt werden. 

Eine mechanisch anspruchslosere Ausführung der taktilen Matrix wird im Bild 7.12 
gezeigt. Halbrunde Silikonstäbe werden bei Andruck auf runde Metallelektroden gepreßt, 
wobei sich durch Vergrößerung der Kontaktfläche der Übergangswiderstand verringert. 
Vorteil dieser Anordnung ist, daß sich durch Bildung von Spalten und Zeilen ein verein¬ 
fachtes Prinzip der Signalauslesung anwenden läßt, das im Bild7.12d dargestellt ist. 
Durch Schließen des Transistors D wird die zugehörige Zeile aktiviert; die einzelnen Ele¬ 
mente werden über einen Analogmultiplexer C abgefragt. Durch den Gegenkopplungs¬ 
zweig B und E wird eine Linearisierung der Kennlinie vorgenommen. 

Taktile Matrizen sind aufgrund ihrer Störanfälligkeit, Verschmutzungsgefahr und der 
durch den Anbringungsort im Greifer bedingten Übertragungsprobleme nur in geringem 
Maße industriell eingesetzt worden. 

Bei neueren Entwicklungen sind die Abtastelektronik und die A/D-Wandlung direkt in 
einem vollständig gekapselten Sensor integriert [7.10] [7.11]. 


7.3. Näherungssensoren 

Näherungssensoren reagieren auf die Anwesenheit eines Objekts in einem durch das Wirk¬ 
prinzip und die Wandlerkonstruktion festgelegten Volumen. Die berührungslose Infor¬ 
mationsübertragung vom Objekt zum Meßwandler erfolgt durch Felder, Wellen oder 
Teilchenströme. Die Meßprinzipien nutzen dabei Unterschiede der physikalischen Eigen¬ 
schaften zwischen dem Objekt und dem erfaßten Volumenbereich aus. Man unterscheidet 
Anwesenheitssensoren, die nur das Vorhandensein eines Objekts oder eines bestimmten 
Objektmerkmals erfassen, und Distanzsensoren, die die Entfernung zwischen dem Sen¬ 
sor und dem Objekt oder einem Teil des Objekts bestimmen. 

Für die unterschiedlichen Aufgabenbereiche von Industrierobotern scheint eine grobe 
Einteilung in die Meßbereiche 0,1 bis 10 mm, 10 und 100 mm bis 1 m sinnvoll. Distanz- 
und Näherungssensoren für den unteren Meßbereich werden nach bekannten Wirkprin¬ 
zipien für viele Automatisierungsaufgaben industriell gefertigt. 

Für die anderen beiden Meßbereiche sind mit der Entwicklung der Robotertechnik 
zahlreiche Lösungen für die Bestimmung von Relativpositionen, Konturverläufen und 
weiteren räumlichen Relationen zwischen Objekten erarbeitet worden, von denen einige 
nachfolgend behandelt werden. Durch die Kombination der Näherungssensoren mit 
definierten Roboterbewegungen lassen sich häufig mehrdimensionale Meßgrößen ge¬ 
winnen. 

7.3.1. Anwesenheitssensoren 

Für die Anwesenheitsbestimmung metallischer Objekte in Abstandsbereichen bis zu 
einigen Zentimetern werden induktive Sensoren eingesetzt. Sie arbeiten nach dem Prinzip 
der Schwingkreisdämpfung oder als offene Differentialtransformatoren und können für 
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bestimmte Schaltabstände geeicht werden [7.12]. Auch offene Kondensatoren lassen sich 
als Näherungsinitiator einsetzen; dabei wird die Deformation des elektrischen Feldes beim 
Eindringen von Körpern mit abweichender Dielektrizitätskonstante und die daraus resul¬ 
tierende Kapazitätsvariation genutzt. 

Mit Hilfe solcher Schaltinitiatoren lassen sich die Anwesenheit von Objekten im Grei¬ 
fer und das Erreichen bestimmter Positionswerte signalisieren. 

Fotodioden 


Bild 7.13 

LED-Fotodioden-Paare zur Anwesenheits¬ 
kontrolle und Zentrierung von Objekten im 
Greifer 



Eine von den Materialeigenschaften der Objekte weitgehend unabhängige Anwesen¬ 
heitsbestimmung ist mit optoelektronischen Lichtschranken realisierbar. Bild 7.13 zeigt 
die Anordnung von LED-Fotodioden-Paaren in den Greifflächen eines Parallelgreifers. Im 
statischen Zustand kann mit ihnen neben der Anwesenheitskontrolle eine grobe Infor¬ 
mation über die Werkstückabmessungen erhalten werden; die erreichbare Genauigkeit 
hängt dabei von der Anzahl der Lichtschranken ab. Wird der Greifer senkrecht zu den 




Bild 7.14 

a) Reflexlichtschranke; b) Reflex¬ 
lichtschranke mit Lichtleiterüber¬ 
tragung 


Lichtschranken bewegt, läßt sich der Eintritt des Objekts in den Strahl sehr genau be¬ 
stimmen. Hierdurch sind auch exakte Objektvermessungen oder Lagebestimmungen mit 
einer oder wenigen Zeilen möglich, wenn mittels des inneren Meßsystems des Industrie¬ 
roboters der vom Greifer zurückgelegte Weg zwischen Eintritt und Austritt des Werk¬ 
stücks aus einem Strahl bestimmt werden kann. Damit ist das Werkstück innerhalb des 
Greifers zentrierbar. Zur Vermeidung der Lichteinstreuung auf benachbarte Fotodioden 
werden die einzelnen Zeilen zyklisch mit der für die geforderte Genauigkeit notwendigen 
Taktfrequenz abgefragt. 

Fremdlichteinfluß wird durch Schwellwertschalter an jedem Diodenausgang weit¬ 
gehend unterdrückt. 

Neben der Anordnung der Fotodiode im Direktlicht der lichtemittierenden Diode sind 
auch Reflexlichtschranken zur Anwesenheitskontrolle und für Zentrieraufgaben geeignet 
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(Bild 7.14 a). Dabei werden die Strahlverläufe durch den Abstand LED-Fotodiode und 
den zwischen den optischen Achsen liegenden Winkel sowie die Linsenbrennweiten so 
justiert, daß ein definierter Detektionsbereich entsteht. 

Bei ausreichender Leistung der Lichtemitterdiode und genügendem Reflexionsvermö¬ 
gen schaltet der Anwesenheitssensor, wenn das Objekt in diesen Bereich eintritt. 

Liegen LED und Fotodiode eng beieinander, können die optischen Achsen parallel ge¬ 
legt werden; der Detektionsbereich fällt dann annähernd mit den Strahlverläufen zusam¬ 
men. Eine auch für kleine Schaltabstände geeignete Strahlführung erreicht man durch 
Anwendung von Lichtleitfasern. Das Prinzip ist im Bild 7.14b dargestellt. Der eine Teil 
des Faserbündels überträgt das emittierte Licht, der andere das reflektierte. Bei streuen¬ 
der Objektoberfläche ist die empfangene Lichtintensität bei Reflexlichtschranken neben 
dem Reflexionsfaktor von der Entfernung Objekt-Fotodiode abhängig. 


Bild 7.15 

Greiferzentrierung mittels zweier Reflex¬ 
lichtschranken und Intensitätsauswertung 

Da die Reflexionseigenschaften am Objekt aber in der Regel stark variieren, z. B. durch 
Krümmung, Oberflächenstruktur, ist eine direkte Ausnutzung der Amplitudeninforma¬ 
tion nicht möglich. Eine Ausnahme bilden Methoden des Intensitätsvergleichs. Im 
Bild 7.15 sind zwei Anwesenheitssensoren so an den Greiferbacken angeordnet, daß durch 
die Auswertung der von einem Objekt gestreuten Lichtintensitäten eine Zentrierung des 
Greifers in der eingezeichneten Bewegungsrichtung erreicht werden kann. Beide Sensoren 
arbeiten als Reflexlichtschranke mit relativ großem Öffnungswinkel. 

Herrschen auf dem Objekt in beiden Strahlkegeln annähernd gleiche Reflexionsverhält¬ 
nisse, ist die Zentrierung erreicht, wenn bei beiden Sensoren gleiche Ausgangssignal¬ 
amplituden auftreten. 

Für optisch spiegelnde Objekte sind Reflexlichtschranken ungeeignet, wenn der Spie¬ 
gelwinkel nicht eingehalten werden kann. 


elektronische elektronische 



7.3.2. Distanzsensoren 

Für die Steuerung von Industrierobotern lassen sich drei Arten der Distanzmessung und 
deren Kombinationen nutzen: 

- Messung des Abstands zwischen Meßwandler und einem Punkt der Objektoberfläche, 

- Messung der mittleren Entfernung zwischen Meßwandler und Objekt (globale Ent¬ 
fernungsmessung), 

- Messung von Distanzen zwischen definierten Objekten oder Teilen dieser Objekte. 
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Bei metallischen oder ferromagnetischen Werkstoffen läßt sich zur groben Abstands¬ 
bestimmung im Nahbereich die Amplitudeninformation induktiver oder kapazitiver 
Meßwandler auswerten. Ist eine Referenzbahn vorgegeben, kann durch einen Abstands¬ 
sensor eine Bahnkorrektur, durch zwei Sensoren eine Bahn- und Orientierungskorrektur 
des Effektors in einer Koordinate vorgenommen werden. Das Prinzip ist im Bild 7.16 



Bild 7.16 

Konturverfolgung mit zwei induktiven 
Distanzsensoren 


dargestellt. Induktive Näherungssensoren haben insbesondere bei der Verfolgung von 
Schweißnähten Anwendung gefunden, wobei die konkrete Sensoranordnung an die Art 
der Schweißnaht und die erwarteten Abweichungen angepaßt ist [7.13]. Bei der Entwick¬ 
lung von Sensoren zur Nahtverfolgung beim Schweißen sind hohe Forderungen an die 
Temperaturfestigkeit, Störsicherheit (Lichtbogen) und die Unempfindlichkeit gegen Ver¬ 
schmutzungen zu erfüllen. Hinzu kommen Forderungen an die Baugröße, um den Ar¬ 
beitsraum nicht zu stark einzuschränken (Schweißen in Ecken). 




Bild 7.17 

Optoelektronische Distanzmessung 

a) MeOprinzip; b) Wirkprinzip positionsempfindlicher Detektoren 


Für den Bereich mittlerer Entfernungen sind zur Messung von Distanzen zwischen 
Meßwandler und Objektoberfläche optoelektronische Meßverfahren geeignet, die auf 
dem Prinzip der Triangulation beruhen. Die Wirkungsweise ist im Bild 7.17 dargestellt. 
Ein Parallellichtstrahl mit möglichst geringem Durchmesser erzeugt auf der Objektober¬ 
fläche einen Lichtfleck; das von der Oberfläche gestreute Licht wird in einem definierten 
Winkel zur optischen Achse des Strahls mittels einer Linse auf ein optoelektronisches 
Wandlerelement abgebildet, das die Lage des Lichtpunktes anzeigt. Als Wandlerelemente 
können in einer Reihe angeordnete Fotodioden oder als Kompaktelement ausgeführte 
Diodenzeilen dienen (s. Abschn. 7.4.). Der Zusammenhang zwischen Abbildungsort und 
Entfernung ist nicht linear; beschränkt man sich auf einen kleinen Meßbereich, kann bei 
entsprechender Wahl der Anordnung und des Abbildungsmaßstabs ausreichende Lineari¬ 
tät erreicht werden. 

Als analogmessende Wandlerelemente sind positionsempfindliche Streifenfotoempfän¬ 
ger nutzbar, deren Wirkprinzip im Bild 7.17 b dargestellt ist. Eine Siliziumfotodiode ist 
als Streifen (3 bis 4 cm Länge) mit drei Kontakten ausgeführt. Bei Lichteinfall mit 
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begrenzter Ausdehnung bildet sich ein Fotostrom aus, der sich aufgrund des Sub¬ 
stratwiderstands lageabhängig auf die beiden Elektroden verteilt. Diese Aufteilung ist 
weitgehend unabhängig vom Durchmesser des Lichtflecks, da die Ppsition des Inten¬ 
sitätsschwerpunkts des Lichtbündels gemessen wird. Mit solchen Elementen sind Ortsauf¬ 
lösungen bis zu 5 [xm bei hoher Linearität auf dem gesamten Diodenstreifen erreichbar. 
Die Lagemessung erfolgt durch Auswertung der Fotostromdifferenz. Da diese von der 
Lichtintensität abhängig ist, sind zur strahlungsflußunabhängigen Lageanzeige spezielle 
Kompensationsschaltungen erforderlich [7.14]. 

Ein weiteres Prinzip der optischen Distanzmessung beruht auf der Auswertung der 
Laufzeit des Lichtes. Dabei werden gemäß Bild 7.18 zwei lichtemittierende Dioden 
quadraturmoduliert; der Fototransistor empfängt über eine geeignete Linse (im Bild 
nicht dargestellt) das von einem kleinen Bereich der Objektoberfläche gestreute Licht der 
beiden LED. Aus der Phasenverschiebung läßt sich durch Vergleich mit den gesendeten 
Signalen in einem Phasendetektor nach der Beziehung 

ip = arctan [{a^ -I- x^)l{b^ + (7.5) 

die Distanz berechnen. Ein Vorteil dieses Verfahrens ist die Unabhängigkeit von der 
reflektierten Amplitude. Die Reflexionseigenschaften des Werkstücks bestimmen ledig¬ 
lich die maximal meßbare Distanz, da die Amplitude des vom Objekt gestreuten Lichtes 
mit dem Quadrat des Abstands abnimmt. Die Modulationsfrequenzen liegen zur Erzie¬ 
lung ausreichender Phasenverschiebungen in der Größe von 1 MHz; dies erfordert den 
Einsatz schnellschaltender Fotoelemente (GaAs-LED) und analoger Bauelemente mit 
hoher Grenzfrequenz. Mit dem in [7.2] vorgestellten Distanzsensor können Entfernungen 
von 10 bis 60 mm bei einer Auflösung von ±1 mm gemessen werden. 



1T aV -fl- 

Sinwl siniwf+i) cosiuf Bild 7.18. Optische Distanzmessung (nach [7.2]) 

Ebenfalls auf der Messung von Laufzeiten beruht die Distanzmessung mittels Ultra¬ 
schalls. Gemäß Bild 7.19 wird die Laufzeit eines ausgesendeten Schallimpulses, der am 
Objekt reflektiert wird, direkt ausgewertet. Mit solchen Anordnungen lassen sich auf¬ 
grund der geringen Richtwirkung von Ultraschall Wandlern, die heute vorwiegend aus 
piezokeramischem Material bestehen, ohne komplizierte Verfahren der Signalauswertung 
nur minimale oder mittlere Entfernungen zwischen Objekt und Wandler bestimmen. 








238 


7 . Sensoren 


Die Messung kleinster Abstände oder Positionsdifferenzen spielt insbesondere bei 
Montageaufgaben eine Rolle. Da die Positioniergenauigkeit von Industrierobotern für die 
Präzisionsmontage in der Regel nicht ausreicht, werden spezielle Nachführeinrichtungen 
eingesetzt, die die Positionsdifferenzen zwischen den zu fügenden Teilen ausgleichen. Im 
Bild 7.20 ist eine Lösung dargestellt, bei der die Positionsdifferenzen mittels pneumati¬ 
scher Sensoren erfaßt werden. Das Prinzip wird im Bild 7.20 a gezeigt. Die Druckluft 
strömt aus je zwei Öffnungen (2) aus, die durch die Montageöffnung (3) unterschiedlich 
abgedeckt werden. Die Staudrucke steuern eine pneumatische Brücke; bei gleicher Ab¬ 
deckung ist die Druckdifferenz Null. Bild 7.20 b zeigt einen vollständigen Fügemechanis¬ 
mus für rotationssymmetrische Teile. Das zu fügende Teil (1) befindet sich zwischen den 
mit zwei Sensorpaaren ausgestatteten Greiferbacken; die Montageöffnung (2) besitzt eine 


10 9 n 70 



Bild 7.20. Pneumatischer Fügemechanismus 

a) Meßprinzip; b) Zentrierung rotationssymmetrischer Teile über Bohrungen mit Fase; c) Zentriermechanismus für 
Bohrungen ohne Fase 



Bild 7.21 

Prinzip der Lagemessung durch 
Auswertung der Reflexionsamplitude 


Fase. Der Differenzdruck steuert in den Druckkammern {10) einen Schieber, der den 
Greifer parallel zur Objektoberfläche bewegt, bis die Druckdifferenz Null ist. Der Greifer 
selbst wird über den Anschluß (7) ebenfalls pneumatisch betätigt. Im Bild 7.20c ist eine 
Anordnung dargestellt, mit der auch Teile ohne Fase justiert werden können [7.7]. Ein 
Vorteil solcher pneumatischer Sensoren besteht in ihrer Robustheit und Störunanfällig- 
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keit; im Wirkungsbereich der Sensoren befindliche Schmutzpartikel werden durch den 
Luftstrom entfernt. Ein Nachteil ist, daß sie für unterschiedliche Teilegrößen und Füge¬ 
aufgaben speziell eingerichtet oder konstruiert werden müssen. Wegen der großen Zahl 
gleichartiger oder ähnlicher Montageaufgaben sind solche Fügemechanismen trotzdem 
sehr effektiv nutzbar. 

Mit Hilfe der sog. Lichtschnittechnik können relative Entfernungen zwischen markan¬ 
ten Teilen von Objekten vermessen werden. Dabei sind sowohl Amplituden- als auch 
Winkelinformationen auswertbar. Im Bild 7.21 ist ein Verfahren zur Schweißnahtverfol¬ 
gung dargestellt, bei dem das unterschiedliche Reflexionsvermögen bestimmter Werk¬ 
stückbereiche ausgenutzt wird. Durch einen beweglichen Spiegel wird ein Lichtpunkt auf 
einer Linie über das Objekt bewegt; die momentane Intensität des reflektierten Lichtes 
wird mittels eines ungerichtet empfangenden Fototransistors ausgewertet und bildet mit 
der momentanen Stellung des Spiegels einen zweidimensionalen Meßwert. Ist die Distanz 
zwischen Sensorelementen und Objektoberfläche bekannt, können Abstände auf dem 
Objekt bestimmt werden. Nachteilig wirkt sich dabei besonders die Abhängigkeit von 
den Reflexionseigenschaften aus; durch Verschmutzungen und unterschiedliche Refle¬ 
xionsfaktoren bei gleichem Oberflächenverlauf kommt es leicht zu Fehlinformationen. 


Werkstück 

a) OszUtoscopregisfrierung b) 

Bild 7.22. Lichtschnittechnik 

a) Prinzip; b) oszillografiertes Meßsignal 

Wird der vom bewegten Spiegel erzeugte Lichtschnitt in einem Winkel zur Ebene des 
Strahlverlaufs betrachtet, lassen sich die Objektkonturen direkt zweidimensional abbilden 
(Bild 7.22). Ein nach diesem Prinzip arbeitender Sensor zur Schweißnahtverfolgung wird 
in [7.15] beschrieben. Die geometrische Anordnung wird im Bild 7.23 a gezeigt. Der 
Lichtschnitt wird durch eine im Infrarot arbeitende Leistungs-LED und einen Drehspie¬ 
gel erzeugt. Der Lichtpunkt auf dem Werkstück wird über eine Sammellinse auf eine 
positionsempfindliche Flächendiode abgebildet. Diese arbeitet wie die im Bild 7.17 dar¬ 
gestellte Streifendiode - nur mit dem Unterschied, daß mittels zweier Kontaktpaare die 
Lichtfleckposition in zwei Dimensionen aus den Fotostromdifferenzen gemessen werden 
kann. Bild 7.23 b zeigt den Positionsverlauf des abgebildeten Lichtflecks für eine Schweiß¬ 
fuge. Neben der Ermittlung des Nahtverlaufs ist aus der senkrechten Verschiebung des 
Lichtschnitts auf der positionsempfindlichen Diode auch die Höhe des Sensors über dem 
Werkstück berechenbar. Die Signalverarbeitung wird im Bild 7.23 c gezeigt. Die LED 
wird zur Unterdrückung von Störlicht mit 10 kHz pulsmoduliert; der Drehspiegel wird 
mit 100 Hz synchronisiert. Der Positionsverlauf wird auf einem Mikrorechner ausgewer¬ 
tet. Hierzu wird durch Einstellen einer Sollposition an einem Werkstück mit Vorgabe der 
Schweißnaht (Stumpfnaht, V-Naht, Kehlnaht) aus der Abweichung zu den gemessenen 
Werten direkt die Korrektur für die Bahnkurvenwerte berechnet. 

Die Vermessung von Objekten ist auch mit Distanzmeßsystemen möglich, wenn an¬ 
stelle der Abtastung mit Dreh- oder Schwingspiegeln eine Scanierung durch die Bewegung 
des am Greifer befindlichen Sensors in einer definierten Weise erfolgt. Die einfachste 
Möglichkeit hierzu ist die Bewegung von Manipulatorgelenken. Die Distanzwerte lassen 
sich dabei direkt den Gelenkkoordinaten zuordnen. 





Schweißfuge 

a) 



b) 



Bild 7.23 

Schweißnahterkennung mit 
optischem Lagemeßsystem 
(nach [7.15]) 


DMA 


\tO-Wandier\ 


Speicher 
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7.4. Visuelle Erkennungssysteme 

Die visuelle Erkennung hat aufgrund der Komplexität der erfaßbaren Umweltinforma¬ 
tion die größte Bedeutung für die Erhöhung der Adaptionsfähigkeit und Flexibilität von 
Robotersystemen. Durch die geringe Wellenlänge des Lichtes und der Unabhängigkeit 
der Ausbreitungsgeschwindigkeit von Umwelteinflüssen ist potentiell ein hohes Auf¬ 
lösungsvermögen vorhanden. 

In Industrierobotersystemen werden visuelle Erkennungssysteme für folgende Auf¬ 
gaben eingesetzt: 

- lagerichtiges Greifen Undefiniert abgelegter oder bewegter Werkstücke, 

- Sortieren unterschiedlicher Werkstücke und Erkennung von Werkstückfehlern, 

- Naht- und Kanten Verfolgung bei technologischen Operationen (z.B. Schweißen), 

- Formerkennung (z.B. beim Farbspritzen), 

- Erkennung von relativen Lagen bei Montageoperationen, 

- Qualitätsüberwachung. 

Die Bildverarbeitungsmethoden lassen sich auf drei grundlegende Aufgabenklassen 
zurückführen, die einzeln oder in Kombination zur Anwendung kommen: 

1. Erkennen von Werkstücken anhand vorgegebener Abbildungsmuster, 

2. Bestimmung der Lage und der Orientierung von Handhabungsobjekten in bezug auf 
ein vorgegebenes Koordinatensystem, 

3. Erkennen und Lokalisierung einzelner Werkstückstrukturen (z.B. Löcher, Ausbrüche, 
Grat, Konturen). 


Lagebestimmung 

Teileklasse 

Schablonenvergleich 



Säuberung Orientierung 

Erzeugung v. Einzelmerkmale 

Konturbildern Schablone 


Bild 7.24. Prinzipieller Aufbau visueller Erkennungssysteme und typische Verarbeitungsalgorithmen 

Man unterscheidet zwischen 2dimensionaler und 3dimensionaler Bilderkennung. 

Der prinzipielle Aufbau visueller Erkennungssysteme ist im Bild 7.24 dargestellt. Die 
optisch-elektrische Wandlung beruht auf der Freisetzung elektrischer Ladungen in einem 
geeigneten Material und erzeugt aus dem optischen Abbild ein entsprechend der Geo¬ 
metrie des Wandlers gerastertes Ladungsbild. Dieses wird durch die Abtasteinheit in ein 
amplitudenmoduliertes, zeitdiskretes Signal umgeformt. Da die weitere Verarbeitung der 
Bildinformation ausschließlich digital erfolgt, wird in der Vorverarbeitungsstufe zunächst 
eine A/D-Wandlung vorgenommen; weitere Vorverarbeitungsalgorithmen richten sich 
nach der Art der Merkmale, die aus dem Bild gewonnen werden sollen. Durch Bild¬ 
reinigungsalgorithmen, Hervorhebung von Konturen und Binarisierung wird die Bild¬ 
information so weit reduziert, daß nur die für die Aufgabe relevanten Teile enthalten sind. 


16 Industricrobotersteuerung 
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Im nachfolgenden Merkmalsextraktor werden aggregierende Beschreibungsmittel gebil¬ 
det, die morphometrischen (z.B. Fläche der Silhouette, Durchmesser, Flächenschwer¬ 
punkt usw.), textuellen (z.B. „über“, „größer“, „Loch im Teil vorhanden“ usw.) oder 
auch spektralen Charakter haben. Der Klassifikator vergleicht diese Merkmale mit den 
gespeicherten Solldaten und generiert ein geeignetes Steuersignal für den Manipulator. 

Die Modellmerkmale können programmiert oder in einer Lernphase durch „Vorzei¬ 
gen“ eines entsprechenden Teiles des Sortiments ermittelt werden. Zusairmen mit den 
zugelassenen Toleranzen definiert der so eingegebene Merkmalsvektor die Objektklasse, 
für n Objekte sind ebenso viele Objektklassen erforderlich. Fällt der im Erkennungspro¬ 
zeß ermittelte Merkmalsvektor nicht in eine der zugelassenen Objektklassen, ist durch 
den Klassifikator ein Rückweisungssignal zu erzeugen; durch Aufruf eines entsprechen¬ 
den Bewegungsprogramms kann dieses Teil dann vom Industrieroboter ausgesondert 
werden. Gemäß den drei Aufgabenklassen ergeben sich folgende funktionelle Schnitt¬ 
stellen zur Industrierobotersteuerung: 

- Erkennung - Aufruf eines Steuerprogramms aus dem Anwenderspeicher, 

- Positions- und Orientierungserkennung - Übergabe von Sollpositionen an die Be¬ 
wegungssteuerung, 

- Lokalisieren von Werkstückstrukturen - Übergabe von Bahnpunkten. 

Die Erkennung einzelner Werkstückstrukturen wird daneben auch zur Qualitätssiche¬ 
rung eingesetzt, z.B. zur Erkennung und Bewertung von Löchern, Grat, Ausbrüchen. 

Die Steuerung von Industrierobotern nach visuell ermittelten Daten erfordert in den 
meisten Fällen kurze Verarbeitungszeiten der Erkennungsalgorithmen, um die Zeit¬ 
bedingungen des technologischen Zyklus einzuhalten. Neben der Auswahl schneller Algo¬ 
rithmen und einfacher Merkmalsextraktionsmethoden werden häufig effektive Hard¬ 
wareimplementierungen vorgenommen. In der Regel werden durch Einschränkungen der 
Objektlagen und zusätzliche Bedingungen wie 

- Teile liegen vereinzelt vor, 

- Teile berühren sich nicht, 

- Teile nehmen nur eine bestimmte Zahl stabiler Lagen ein, oder 

- es kommt nur eine bestimmte Klasse von Teilen vor 

der Verarbeitungsaufwand zur Erfüllung von Echtzeitforderungen eingeschränkt. Dies 
geschieht auf Kosten eines zusätzlichen Aufwands in der Peripherie des Roboters. 

In den nachfolgenden Abschnitten werden diese Verarbeitungsschritte und einige den 
Algorithmen zugrunde liegende Methoden nacheinander am Beispiel der 2-D-Erkennung 
behandelt. 

Verfahren zur 3-D-Erkennung unterscheiden sich hiervon durch das wesentlich größere 
zu verarbeitende Datenmassiv einschließlich des zu speichernden Modellwissens und an¬ 
dere Methoden der Bildaufnahmetechnik, die im Abschnitt 7.4.6. dargestellt sind. 


7.4.1. Bilderzeugung und Bildwandlung 

Merkmalsgewinnung und Mustervergleich erfolgen durch Auswertung eines binären 
2-D-Bildes des Objekts. Man unterscheidet dabei zwischen einem Silhouettenbild und 
einem Konturbild (Bild 7.25). Während beim Silhouettenbild die vollständige Schwarz¬ 
weißinformation vorliegt, werden beim Konturbild nur die Schwarzweißübergänge erfaßt. 
Der Übergang vom Silhouettenbild zum Konturbild stellt eine Differenzierung dar und 
bedeutet keinen Informationsverlust. 
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Ziel der Bilderzeugung und Bildwandlung ist die Erstellung eines elektrischen Abbild¬ 
signals, aus dem mit möglichst geringem Verarbeitungsaufwand ein der Silhouette oder 
Kontur entsprechendes Signal gewonnen werden kann. 



Werkstück 



Silhouette Kontur Silhouetten- ( a) und Konturbild ( b) 

a) b) 


Beleuchtungstechnik, Bildfenster und Anordnung der Objekte sind bei Beachtung der 
technologischen Gegebenheiten so zu gestalten, daß bereits die optische Abbildung auf 
dem Bildwandler kontrastreich ist und nur die zu erkennenden bzw. zu unterscheidenden 
Objekte enthält. Die günstigsten Voraussetzungen zur Erzeugung eines kontrastreichen 
Binärbilds bietet die Durchlichtmethode. Das Objekt wird auf einer diffus streuenden, 
durchscheinenden Unterlage angeordnet, die von unten beleuchtet ist (Bild 7.26 a). Da 
undurchsichtige Schmutzpartikel ebenfalls mit gutem Kontrast abgebildet werden, ist die 
Durchlichtmethode praktisch nur in wenigen Fällen einsetzbar. 


Kamera 


Kamera 



durchscheinende 
^ Auflage 



a) X b) 


Auflage 



X 


Bild 7.26 

Beleuchtungstechniken der 
2-D-Erkennung 

a) Durchlichtmethode; 

b) Auflichtmethode 


Die im Bild 7.26b schematisch dargestellte Auflichtmethode beruht auf dem unter¬ 
schiedlichen Reflexionsvermögen von Objekt und Untergrund. 

Weitere Beleuchtungstechniken sind die aus der Mikroskopie bekannten Hellfeld- und 
Dunkelfeldbeobachtung, bei denen Lichtquelle und Kamera so angeordnet werden, daß 
entsprechend dem Reflexionsgesetz ebene Flächen hell oder dunkel erscheinen, während 
an Kanten oder Störungen in der Bildoberfläche eine Streuung auftritt. 

Die Wahl der günstigsten Beleuchtung hängt neben den technologischen Möglichkei¬ 
ten von der Beschaffenheit der Objekte und der durch die Erkennung zu lösenden Auf¬ 
gabe ab und wird in der Regel durch Vorversuche zu klären sein. 

Das von der Kamera erfaßte 2dimensionale Silhouettenbild eines i. allg. 3dimensiona- 
len Werkstücks ist gemäß Bild 7.26 von seiner Ausdehnung in x- und j^-Richtung und 
damit von der momentanen Lage abhängig. Drehungen des Teiles um die x- oder _v-Achse 
ändern außer bei vollständiger Rotationssymmetrie die Silhouette. In diesem Abschnitt 
wird der Begriff Lage nur auf die Drehlage bezüglich dieser beiden Koordinatenachsen 
angewendet. Je nach Teilebeschaffenheit lassen sich unterschiedlich viele stabile, instabile 
und indifferente Teilelagen unterscheiden. Indifferente Gleichgewichtslagen können zu 
unendlich vielen möglichen Silhouettenbildern führen; eine Erkennung ist dann im all¬ 
gemeinen Fall nicht möglich. 
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Die Drehlage des Werkstücks um die z-Achse wird in der visuellen Erkennung als 
Orientierung bezeichnet. Änderung der Teileorientierung ändert das Silhouettenbild 
nicht, wenn man von optisch bedingten Abbildungsfehlern absieht. Die x- und j-Koordi- 
naten eines ausgewählten Punktes des Silhouettenbilds bezeichnet man als Position; in 
der Regel werden zur Positionsangabe die x- und >-Werte des Flächenschwerpunktes der 
Silhouette genutzt. 

Das objekteigene Frame kann somit nur bezüglich der x- und Werte des Positions¬ 
vektors im Basiskoordinatensystem (s. Abschn. 4.6.2.) und des Orientierungswinkels 0 
variieren. Für unterschiedliche Teilelagen sind ebenso viele Objektframes zu definieren, 
in denen z. B. mögliche Greifpositionen Tg angegeben werden können. 

Die Wandlung des mittels einer geeigneten Optik erzeugten Abbilds in ein elektrisches 
Signal erfolgt bei allen bekannten Bildwandlersystemen durch Freisetzung von Ladungen 
in einem halbleitenden Material. Im Prinzip besteht jedes Bildwandlungssystem aus einer 
mehr oder minder großen Zahl von Kondensatoren, die durch fotoelektrische Effekte auf- 
geladen werden. Die Größe der Ladung hängt dabei von der Wellenlänge und Intensität 
des Lichtes und der Dauer der Aufladung ab. Durch die Strukturierung der einzelnen 
Kondensatoren auf der Wandlerfläche entsteht ein sog. Rasterbild, das die mögliche Auf¬ 
lösung begrenzt. 

Das älteste und am weitesten verbreitete Bildwandlersystem ist die Fernsehkamera. 
Über ein Ablenksystem tastet ein Elektronenstrahl zeilenweise die Bildpunkte ab und 
entlädt die Kondensatoren; der dabei auftretende Entladungsstrom entspricht der Hellig¬ 
keit des Bildpunktes. Bei üblichen Fernsehnormen wird das Bild in 625 Zeilen zerlegt, 
wobei das Abtasten jeder Zeile 64 (xs dauert, ein vollständiges Bild wird in s gewan¬ 
delt. Die Positionsbestimmung eines Bildpunktes kann bei gegebener Bild- und Zeilen¬ 
frequenz unmittelbar über eine Zeitmessung erfolgen. 

Aufgrund der durch die Nichtlinearität der horizontalen und vertikalen Elektronen¬ 
strahlablenkung entstehenden Abbildungsfehler sind Fernsehkameras für industrielle Er- 
kennungs- und Meßaufgaben nur bedingt einsetzbar. 



Exakte Bildwandlungen ermöglichen CCD-Kameras (charge coupled c/evices), mit de¬ 
ren Entwicklung 1970 begonnen wurde. 

Das Prinzip der fotoelektrischen Wandlung in CCD-Elementen wird im Bild 7.27 a 
gezeigt. Auf einem p-dotierten Siliziumsubstrat ist eine 100 bis 300 nm dünne Silizium¬ 
dioxidschicht aufgebracht. Durch Anlegen einer Spannung zwischen Metallelektrode 
und Substrat bildet sich um die Elektrode eine Verarmungszone, die durch fotoelektrisch 
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erzeugte Elektronen aufgefüllt wird. Setzt man die Spannung kurzzeitig Null, bildet sich 
ein Ladestrom, der dem Photonenstrom proportional ist. Ordnet man gemäß Bild 7.27 b 
mehrere solcher Kondensatoren in einer Reihe an, kann die Ladung eines Kondensators 
durch Anlegen geeigneter Taktspannungen an den Nachbarelektroden von diesen über¬ 
nommen und an der letzten Elektrode seriell ausgelesen werden. Dabei sind zum definier¬ 
ten Ladungstransport drei Elektroden notwendig - eine gibt das Ladungspaket ab; eine 
andere übernimmt die Ladung, und eine weitere verhindert das Zurückfließen. Nach 
diesem Prinzip lassen sich CCD-Zeilen aufbauen mit Bildpunktabmessungen bis zu 
10 (zm X 10 fim. Da während des Ladungstransports durch die einzelnen Elemente zu¬ 
sätzliche Ladungen durch Lichteinfall entstehen, muß die gesamte Zeile während sehr 
kurzer Zeit ausgelesen werden. Deshalb wird dieses Ausleseprinzip heute kaum noch 
angewendet. Eine zweite Möglichkeit zum Auslesen der Bildpunkte wird im Bild 7.28 
gezeigt. Die CCD-Elemente - hier als Ersatzschaltbild durch Diode und Kondensator 
dargestellt - werden über einen MOS-Transistor nacheinander auf die gemeinsame Aus¬ 
gangsleitung geschaltet. Der hierzu erforderliche Taktimpuls wird durch ein ebenfalls auf 
dem Substrat integriertes Schieberegister erzeugt. Dabei wird der Kondensator auf 5 V 



Bild 7.28 

Ersatzschaltbild einer CCD- 
Zeile, das Auslesen erfolgt 
mittels getakteten Schiebe¬ 
registers auf die gemeinsame 
Videoleitung 



Bild 7.29. Aufbau der CCD-Zeile LI 10 des VEB Werk für Fernsehelektronik [7.17] 
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aufgeladen; bis zum nächsten Taktimpuls findet eine dem Fotostrom der Diode propor¬ 
tionale Entladung statt. Der auf der Ausgangsleitung entstehende Fotostrom ist der 
Beleuchtung proportional. Da die fotoelektrische Ladungsbildung der Beleuchtungszeit 
proportional ist, kann durch Veränderung der Taktzeiten das Ausgangssignal geregelt 
werden. Hierdurch lassen sich Übersteuerungen (vollständige Kondensatorentladung) 
vermeiden und die Empfindlichkeit der Kamera an die Beleuchtungsstärke anpassen. Am 
Ende einer Ausleseperiode wird vom Schieberegister ein längerer Impuls erzeugt, der das 
Zeilenende markiert. 

Ein weiteres Ausleseprinzip benutzt zwei nebeneinanderliegende CCD-Zeilen. In der 
ersten findet die fotoelektrische Wandlung statt, während die zweite Zeile gemäß 
Bild 7.27b den Ladungstransport übernimmt und nicht beleuchtet wird. Den Aufbau 
einer nach diesem Prinzip arbeitenden, handelsüblichen Zeile zeigt Bild 7.29. Die 
256 lichtempfindlichen CCD-Elemente sind in einer Reihe angeordnet und durch einen 
mäanderförmig eindiffundierten Trennkanal voneinander separiert. Auf jeder Seite der 
Bildempfängerzeile ist ein Übertragungsgate angeordnet, das im geöffneten Zustand die 
Ladung jedes zweiten Bildelements in eine Transport-CCD-Zeile übergibt. Die Ladungen 
der ungeradzahlig bezifferten Elemente gelangen in die Transportzeile A, die der gerad¬ 
zahligen in die Transportzeile B. Diese Ladungsübernahme erfolgt in der Transportpause 
in den Zeilen A und B. Während der nachfolgenden Lichtintegration in den Bildelemen¬ 
ten sind die Übertragungsgates gesperrt, und es erfolgt das Auslesen der Transportzeilen 
durch Taktimpulse zwischen den Steuerleitungen G. Die Anordnung der beiden letzten 
Elemente der Analogregister A und B bewirkt eine alternierende Einspeisung der Ladungs¬ 
bilder über ein Ausgangsgate in den Ladungsdetektor, so daß die richtige Reihenfolge der 
Ladungsbilder gewährleistet ist. 



RücksfcUtakt- 

unfcrdrückung 


Bild 7.30 

Beschaltung einer CCD-Zeile 


Die Transportregister übergeben die Ladungsbilder an eine vorgespannte Diode, die 
mit einer Potentialänderung reagiert. Diese Potentialänderung steuert die Gateelektrode 
eines MOS-Ausgangstransistors, der eine Videospannung an SO erzeugt. Der Rückstell¬ 
transistor Tj. wird durch einen Rückstelltaktimpuls an GR gesteuert und sichert das Nach¬ 
laden der Detektordiode zur Wiederherstellung der Vorspannung, bevor ein neues 
Ladungsbild eintrifft. Die Kompensationsstufe wird nur vom Rückstelltaktimpuls ge¬ 
steuert und liefert an CS ein Signal, das gleich den im Videosignal enthaltenen Rückstell¬ 
taktimpulsen ist. Dieses Signal wird in einem externen DifFerenzverstärker zur Unter¬ 
drückung des Rückstellimpulses im Videosignal benutzt. 

Die prinzipielle Beschaltung einer CCD-Zeile wird im Bild 7.30 gezeigt. Im Taktgene¬ 
rator werden alle erforderlichen Steuersignale erzeugt; die Taktsteuerung dient der An¬ 
passung der Ladungsintegrationszeit an die Beleuchtungsverhältnisse. Bei gutem Kon¬ 
trast kann das Videosignal mittels eines Schwellwertschalters direkt in ein Binärbild ge- 
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wandelt werden; andernfalls ist eine A/D-Konvertierung notwendig, bevor durch weitere 
Verarbeitungsschritte, die im folgenden Abschnitt besprochen werden, eine Binarisierung 
durchgeführt wird. Da mit CCD-Zeilen nur ein linienhafter Bildausschnitt erfaßt wird, 
ist zur Abbildung der vollständigen Silhouette eine Relativbewegung von Kamera und 
Objekt senkrecht zur abgebildeten Linie in der Bildebene erforderlich. Dies kann ent¬ 
weder durch Bewegung der Kamera oder des Werkstücks (Transportband, lineare Ver¬ 
fahreinheit) erfolgen. Die Transportgeschwindigkeit ist dabei so zu steuern, daß die nach¬ 
einander abgetasteten Zeilen so dicht beieinander liegen wie die Bildpunktelemente, damit 
eine gleichmäßige Auflösung des Bildes erreicht wird. 



Bild 7.31 

Ausleseprinzipien bei CCD-Matrizen 


Mutfip/excr 


CCD -Analog-Sbhieberegisfer 

b) 


Multiplexer 



CCD - Elemenfe CCD - Analog - Schiehe- 
c) registcr 


Die Anzahl der Bildpunktelemente einer Zeile riy und die Zahl der beim Transport ab¬ 
getasteten Zeilen bestimmen die Anzahl der Rasterpunkte des Bildes und damit die 
erreichbare Auflösung. Ordnet man mehrere CCD-Zeilen nebeneinander auf einem Chip 
an, wird während eines Abbildungsvorgangs die vollständige 2-D-Information erhalten. 
Im Bild 7.31 sind die möglichen Ausleseprinzipien für CCD-Matrizen dargestellt. Am 
Ausgang wird ein Videosignal gebildet, in dem alle Zeilensignale aufeinander folgen. 
Zwischen den Zeilen werden Zeilenendsignale eingefügt; zwischen den vollständigen 
Bildsignalen liegen Bildendimpulse. CCD-Matrizen werden bereits mit bis zu 800 x 800 
Bildpunkten gefertigt. 

Werden nur geringe Forderungen an das erreichbare Auflösungsvermögen der Kamera 
gestellt, können durch matrixförmige Anordnungen von einzelnen Fotoelementen preis¬ 
günstige Kameras hergestellt werden. Solche Sensoren sind besonders für Überwachungs¬ 
und Kontrollfunktionen in unmittelbarer Objektnähe, z. B. am Greifer eines IR, einsetz- 
bar; das Ausleseprinzip entspricht dabei dem im Bild 7.31 c dargestellten. Ist die Anbrin¬ 
gung der Kamera aus Platzgründen am Beobachtungsort direkt nicht möglich, kann zur 
Übertragung der optischen Bilder auch die Lichtleittechnik eingesetzt werden. Auf die im 
Prinzip aus der Endoskopie bekannten Techniken soll hier nicht weiter eingegangen werden. 
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7.4.2. Bildvorverarbeitung 

Die erforderlichen Algorithmen und Verarbeitungsschritte zur Bildsäuberung und -restau- 
rierung ergeben sich aus den Eigenschaften des von der Kamera erfaßten Silhouettenbilds 
und den anzuwendenden MerkmalsextraJctionsverfahren. Man unterscheidet Algorith¬ 
men zur Bildglättung, -Säuberung, -restaurierung, Konturenverschärfung und Kanten¬ 
detektion. Ziel ist die Herstellung eines binären Silhouettenbilds des zu erkennenden 
Objekts bei Unterdrückung aller Störungen - unabhängig davon, ob diese im Objekt- 



Bild 7.32. Wirkungsweise des Medianoperators 

a) 3 X 3-Maske und deren Verschiebung im Bildpunktraster; b) Histogramm, beim Medianoperator wird der Grauwert mit 
n = 5 im Histogramm dem Zentralpunkt Z als neuer Grauwert zugewiesen 



Bild 7.33. Anwendung von Rangordnungsoperatoren auf ein Binärbild 

a) Original; b) R 2.5 (Medianoperator); c) ^j .7 
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bereich (z.B. durch Verschmutzung der Unterlage) oder während der Aufnahme und 
Verarbeitung entstanden sind. 

Liegt ein kontrastreiches Bildmaterial vor, läßt sich aus diesem durch Einführen einer 
Schwelle relativ einfach ein Binärbild erzeugen. Zur Vor Verarbeitung eines gerasterten 
Grauwertbilds ist zunächst eine A/D-Umsetzung notwendig; je nach Kompliziertheits¬ 
grad des Bildes werden 8, 16 oder 32 Graustufen unterschieden. 

Charakteristisch für Vorverarbeitungsalgorithmen sind lokale Bildverarbeitungsver- 
fahren, sog. Maskenoperationen. Sie erfüllen gleichzeitig mehrere Aufgaben. Das Prinzip 
beruht darauf, daß die ursprünglichen Grauwerte oder Binärwerte eines Rasterpunktes 
durch arithmetische oder logische Verknüpfung mit den Umgebungspunkten neu be¬ 
stimmt werden. Die Größe solcher Masken kann beliebig gewählt werden; aus Auf¬ 
wandsgründen kommen vorzugsweise 3 x 3-Masken zur Anwendung. Die Wirkungs¬ 
weise soll am Beispiel des Medianoperators erläutert werden, der von Pratt [7.19] erst¬ 
mals in der Bildverarbeitung angewendet wurde. Das Prinzip des Medianoperators be¬ 
steht darin, daß die Grauwerte aller Maskenpunkte der Größe nach in einem Histogramm 
geordnet werden und der in der Mitte liegende Wert dieser Folge (bei einer 3 x 3-Maske 
der Grauwert an der fünften Stelle) dem Zentralpunkt Z als neuer Grauwert zugewiesen 
wird (Bild 7.32). Dieser Operator wird Bildpunkt für Bildpunkt nacheinander auf jede 
Zeile angewendet, wobei stets die darüber- und darunterliegende Zeile benötigt werden. 
Der Medianoperator mit 3 x 3-Maske bewirkt eine Glättung der Kontur, die Unter¬ 
drückung von Störflecken mit einer Ausdehnung bis zu vier Rasterpunkten sowie die Be¬ 
seitigung von Linien mit der Breite eines Rasterpunktes. Bild 7.33 veranschaulicht diese 
Eigenschaften für ein Binärbild; die Bildgröße wird durch diese Maskenoperationen an 
den Außenkanten um eine Rasterbreite verringert. Die Leistungsfähigkeit solcher Mas¬ 
kenoperatoren verdeutlicht Bild 7.34, wo eine Gitterstruktur der Objektauflage vollstän¬ 
dig durch einen Operator eliminiert wird bei relativ geringen Verzerrungen des Objekts. 
Hier wurde eine Maskenoperation angewendet, bei der nicht der fünfte, sondern der 
dritte Histogrammwert dem Zentralpunkt als neuer Wert zugewiesen wird. Beide ge¬ 
nannte Operatoren gehören zur Klasse der Rangordnungsoperatoren R^,„; A bezeichnet 
die Größe der quadratischen Nx A-Maske und n den Rang in der geordneten Folge von 
A X A Grauwerten, dessen Wert als neuer Grauwert des Zentralpunktes benutzt wird. 
Wird ein niedriger Rang benutzt, werden größere Störflecken unterdrückt; gleichzeitig 
tritt jedoch eine verstärkte Erosion der Kontur auf. Rangordnungsoperatoren sind damit 
geeignet, periodische oder linienförmige Strukturen im Bild zu unterdrücken, wie sie z.B. 
durch Verwendung von Transportnetzen bei der Durchlichtmethode auftreten sowie 
Kratzer, Rillen und Verschmutzungen zu beseitigen, wenn der Rang entsprechend ge¬ 
wählt wird. 

Weitere Maskenoperatoren werden zur Bildung sauberer Schwarzweißübergänge aus 
dem Grauwertbild (Kantenverschärfung, Kantendetektion), zur Bestimmung eines ein¬ 
deutigen Binärübergangs und zur Umfangsbestimmung aus dem Binärbild eingesetzt. 
Einige dieser Operatoren und ihre Wirkung sind in Tafel 7.2 dargestellt. 

Maskenoperationen werden aufgrund ihrer zyklischen Arbeitsweise zur Erzielung 
hoher Verarbeitungsgeschwindigkeiten zweckmäßigerweise hardwaremäßig implemen¬ 
tiert. 

Für die Merkmalsgewinnung bei der 2-D-Erkennung wird ein binäres Bild benötigt. 
Zur Binarisierung des von der Kamera erzeugten und evtl, schon verbesserten grauwerti¬ 
gen Bildes ist eine Schwelle S erforderlich, die jeden Bildpunkt entweder der Objektbild¬ 
punktmenge oder der Untergrundbildpunktmenge zuordnet. Eine intuitive Festlegung 
der Schwelle S ist nur für sehr großen Objekt-Untergrund-Kontrast möglich. Zur Selek- 



Tafel 7.2. Beispiele für Maskenoperationen mit ix 3-Fenster 
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tion optimaler Schwellen wurden zahlreiche Methoden entwickelt; hier soll nur die 
Histogrammethode dargestellt werden. Diese beruht auf der Auswertung der Häufigkeits¬ 
verteilung der Grauwerte des gesamten Bildes. Ordnet man jedem Grauwert die Anzahl 
der Bildpunkte zu, die diesen Grauwert enthalten, und ordnet diese in der Reihenfolge der 
Grauwerte, so entsteht ein Histogramm, das bei gutem Objekt-Hintergrund-Kontrast 
zwei Maxima enthält. Legt man die Schwelle in den Grauwert, der dem zwischen den 
Maxima liegenden Minimum entspricht, ist eine gute Trennung zwischen Objektbild¬ 
punkten und Hintergrundbildpunkten möglich (Bild 7.35 a). 




Bild 7.35. Bildhistogramme mit 16 Graustufen und Festlegung der Binarisierungsschwelle 
a) nach der Minimummethode; b) anhand einer Grauwertschulter 


Häufig läßt sich dieses Minimum jedoch nur schwer lokalisieren. Bild 7.35b zeigt die 
Selektion einer Schwelle mittels einer sog. Grauwertschulter. 

Treten im Histogramm mehrfach Minima oder Grauwertschultern auf, lassen sich 
mehrere Schwellen selektieren. Die Zugehörigkeit des betreffenden Bildpunktes zum Ob¬ 
jekt oder Untergrund wird danach anhand der Punktumgebung durch entsprechende 
Maskenfilterung oder andere Klassifikationsalgorithmen entschieden [7.22]. 

Nach der Erstellung des Binärbilds, die in der Regel durch eine angepaßte Hardware 
erfolgt, ist dieses zur weiteren Verarbeitung im Mikrorechner zwischenzuspeichern. Die 
vollständige Abspeicherung erfordert rixtiy Speicherplätze. Die Anzahl der erforderlichen 
Speicherplätze kann für wenig strukturierte Bildinformation wesentlich reduziert werden, 
wenn anstelle aller Bildpunkte nur diejenigen abgespeichert werden, die eine echte Infor¬ 
mation enthalten. In unserem Fall sind dies die Schwarzweißübergänge. Es ist also aus¬ 
reichend, nur diese Übergänge als Adresse in x- und j-Richtung anzugeben. Ist ein Objekt 
vollständig im Bildformat enthalten, kann beim Abtasten einer Bildzeile auf einen 
Schwarzweißübergang nur ein Weißschwarzübergang folgen und umgekehrt. Ein Ver¬ 
fahren, das diese Tatsache zur Bildspeicherung nutzt, ist das sog. „run-length-coding“. 
Hier wird lediglich die erste Adresse eines Übergangs und die folgende Bildpunktzahl mit 
gleichem Binärwert gespeichert. 


7.4.3. Merkmalsgewinniing und Klassifikation 

Aus dem 2dimensionalen Binärbild lassen sich morphometrische Merkmale berechnen, 
die die Abbildung in verkürzter Form beschreiben - sie werden auch als „Repräsentan¬ 
ten“ des Objekts bezeichnet. Die zu erkennenden Teile besitzen i.allg. je nach momen¬ 
taner Lage unterschiedliche Silhouettenbilder. Diese werden bei der Auswertung wie 
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unterschiedliche Objekte behandelt, d.h., zu jedem möglichen Silhouettenbild sind die 
zugehörigen Repräsentanten in der Lernphase zu bestimmen und in der Erkennungsphase 
anhand der abgespeicherten Modelldaten zu vergleichen. Die Erkennung ist damit nur 
möglich, wenn das Teil eine endliche Zahl von stabilen Lagen auf der Unterlage ein¬ 
nimmt oder die Merkmale gegenüber silhouettenverändernden Drehungen invariant sind 
(Rotationskörper). 

Unter der Voraussetzung, daß sich die Repräsentanten aller Objekte des betrachteten 
Teilesortiments - also aller Teile in allen stabilen Lagen - voneinander unterscheiden, 
liefert der Erkennungsprozeß zwei Aussagen: zum einen die Teileklasse und zum andern 
die Lageklasse. Die Art der auszuwählenden Merkmale richtet sich damit nach der Er¬ 
kennungsaufgabe - es sind diejenigen Merkmale zu benutzen, die die Separierung der 
Objekte gewährleisten. 

Einige für die Teileerkennung häufig benutzte, direkt berechenbare oder abgeleitete 
Merkmale sind: 

(Z),., Dy) Abmessungen des achsenparallelen Rechtecks, das das Objekt in der momen¬ 
tanen Lage umschreibt, 
abgeleitet: Dg Diagonale dieses Rechtecks 
F Flächeninhalt des Objekts mit oder ohne Lochflächen, 

abgeleitet: s/F, DJF, DljF 

Kp Anzahl der Konturpunkte des Objekts (einschließlich bzw. ausschließlich der 
Konturpunkte von Löchern im Objekt) 

U Umfang des Objekts (einschließlich bzw. ausschließlich des Umfangs von Lö¬ 

chern), 

abgeleitet: Fok = A-xFjU^ Kreisformfaktor 
s^F/U Kompaktheit 
Z Anzahl der Löcher im Objekt 

Lf(i) Fläche des i-ten Loches, 

abgeleitet: Summe aller Lochflächen 

Verhältnis der Summe aller Lochflächen zur Gesamtlochzahl usw. 

Weitere wichtige Merkmale lassen sich aus den Flächenträgheitsmomenten gewinnen. 
Sind Sx und Sy die Rasterkoordinaten des Flächenschwerpunktes, so gilt für die Zentral¬ 
momente bezüglich der x- und >^-Achse 

r = i f (a- - 0- - s/ B (a, >-)■ (7.6) 

y= \ jc= 1 

B{x, y) ist eine Belegungsfunktion; für einen Objektpunkt ist D = 1, sonst Null. Innerhalb 
der Lochfläche kann B = 1 bzw. Null gesetzt werden, je nachdem, ob die Lochfläche be¬ 
rücksichtigt werden soll oder nicht. Mit a = b = 0 wird die Objektfläche gewonnen. Für 
a = l, b = 0 und a = 0, b = \ ergeben sich die Schwerpunktkoordinaten. Außerdem er¬ 
geben sich mit 

a = 2, b = 0 Txx quadratisches Flächenträgheitsmoment 
bezüglich der A:-Achse 

a = 0, b = 2 Tyy quadratisches Flächenträgheitsmoment 
bezüglich der j-Achse 

sowie das polare Flächenträgheitsmoment 

T T 4 - 7 ' 
p .x;c ~ y;» • 


(7.7) 
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Diese Flächenträgheitsmomente sind orientierungsabhängig, ebenso alle weiteren Mo¬ 
mente höherer Ordnung (a + b > 2). Aus den Flächenträgheitsmomenten bezüglich der 
Rasterkoordinatenachsen lassen sich die orientierungsunabhängigen Hauptträgheits¬ 
momente des Objekts (Objekt bedeutet in diesem Zusammenhang immer Binärbild, also 
Fläche) bestimmen: 

T„, r„ = TJ2 + Vcr,, - r„)V4 + r/,. (7.8) 

Txy ergibt sich aus Gl. (7.6) durch a = 1,6= 1. 

Wurde der Flächenschwerpunkt {s^, ^y) bestimmt, lassen sich einige von diesem aus¬ 
gehende ausgezeichnete Radien zu den Konturpunkten als Merkmale bestimmen. Sind 
rJJ), ry(i) die Rasterkoordinaten der Konturpunkte, gilt allgemein für die vom Flächen¬ 
schwerpunkt ausgehenden Objektradien 

R(i) = V(/-,(0 - ^jc)^ + (ryU) - s^y. (7.9) 

Durch Vergleich lassen sich die extremalen Radien R^in und /?n,ax sowie der mittlere 
Objektradius bestimmen. 

Verfolgt man von einem Punkt ausgehend die Kontur und ermittelt den zugehörigen 
Objektradius, so tritt bei bestimmten konkaven Konturverläufen eine sog. Rückläufig¬ 
keit des Radiuswinkels auf, die ebenfalls als Merkmal dienen kann [7.23] (Bild 7.36). 




Bild 7.36 

Rückläufigkeit des Radiuswinkels als Erkennungs- und 
Orientierungsmerkmal 


Ausschlaggebend für die Auswahl von Merkmalen ist neben den Eigenschaften der zu 
erkennenden Objekte die Laufzeit der zugehörigen Algorithmen auf der verwendeten 
Rechentechnik. Auf die zahlreichen Methoden zur effektiven Merkmalsberechnung und 
die verwendeten Algorithmen, die zum großen Teil auf Maskenoperationen sowie rechen¬ 
technisch einfach realisierbaren Operationen, wie Verschiebung, Vergleich, Addition und 
Subtraktion, beruhen, soll hier nicht näher eingegangen werden. Eine umfangreiche 
Literaturzusammenstellung findet sich in [7.24] [7.26]. 

Der Klassifikator vergleicht die aus dem Objekt ermittelten Merkmale mit denen der 
abgespeicherten Modellobjekte und ordnet das Objekt in die zugehörige Objektklasse ein. 
Sind unterschiedliche Teilelagen zugelassen, entspricht die Objektklasse jeweils einer sta¬ 
bilen Lage des zu erkennenden Teiles; bei k stabilen Lagen sind für ein zu erkennendes 
Teil k Objektklassen, für n Teile «kj Objektklassen zu definieren. Sollen die Teile in be¬ 
liebiger Position und Orientierung erkannt werden, können nur positions- bzw. orien¬ 
tierungsunabhängige Merkmale zur Klassifikation benutzt werden. An den Klassifikator 
sind gewisse Robustheitsforderungen zu stellen, die die möglichen Teiletoleranzen, Ab¬ 
bildungsfehler und bei der Vorverarbeitung und Merkmalsbildung auftretende Rundungs¬ 
fehler betreffen. Der Aufbau von Klassifikatoren kann dabei nach zwei unterschiedlichen 
Prinzipien erfolgen. 

Bei der parallelen Klassifizierung werden alle Merkmale gleichzeitig zum Vergleich an- 
geboten. Hierzu ist es erforderlich, daß alle zur Unterscheidung der Objekte benötigten 
Merkmale ausreichend schnell bestimmt werden können. Sind statistisch erfaßbare Stö- 
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rungen bei der Ermittlung der Objektmerkmale von Bedeutung, ist ein statistisches Klas¬ 
sifikationsverfahren anzuwenden. Einen optimalen Klassifikator liefert dann die Bayes- 
Regel, ergänzt durch Rückweisungsbedingungen, wenn das Objekt in keine der vorge¬ 
sehenen Klassen einordenbar ist [7.25] [7.26]. 

Die sequentielle Klassifikation beruht auf der Tatsache, daß zur Erkennung der Ob¬ 
jekte nicht immer alle Objektmerkmale herangezogen werden müssen. Es werden durch 
eine Interaktion zwischen Klassifikator und Merkmalsbestimmung nur diejenigen Merk¬ 
male berechnet, die zur Einordnung der Objekte notwendig sind. Hierdurch ist in der 
Regel eine erhebliche Reduktion des Rechenaufwands möglich. 



Bild 7.37 

Beispiel eines Entscheidungs¬ 
baums zur Objektklassifikation 


Eine Variante zur sequentiellen Klassifikation ist der Aufbau sog. Entscheidungs¬ 
bäume, die nachfolgend an einem einfachen Beispiel erläutert werden soll. Die Knoten 
des im Bild 7.37 dargestellten Entscheidungsbaums stellen Trennebenen für die Merk¬ 
male dar. Ist das berechnete Objektmerkmal größer als ein in der Lernphase eingegebener 
Wert, wird der rechte nachfolgende Knoten berechnet; ist es kleiner, der linke. Eine Be¬ 
rechnung der absoluten Merkmalsabweichung entfällt, d.h., der Algorithmus wird sehr 
schnell arbeiten. Die Knoten werden nacheinander abgearbeitet, bis der Endknoten 
erreicht ist; er entspricht der ermittelten Objektklasse. Solche Entscheidungsbäume kön¬ 
nen sehr effektiv der geforderten Erkennungsgenauigkeit und der Anzahl der zu unter¬ 
scheidenden Teile angepaßt werden. In diesem Beispiel wurde auch ein Merkmal be¬ 
nutzt, das nicht vollständig orientierungsunabhängig ist, nämlich die Diagonale des um¬ 
schreibenden Rechtecks. Diese läßt sich aber sehr effektiv berechnen und dient häufig der 
Unterscheidung von Teilen mit unterschiedlicher Kompaktheit. Um ein Teil, das auf der 
Ablagefläche eine beliebige Position und Orientierung einnehmen kann, mit dem Mani¬ 
pulator richtig zu greifen, ist das Frame in eine bestimmte Relation zum objekteigenen 
Koordinatensystem zu bringen, in dem die Greifpunkte angegeben sind. Zur Bestimmung 
des Positionsvektors p kann der Flächenschwerpunkt {s^, Sy) herangezogen werden. 
Wesentlich aufwendiger ist die Berechnung des Orientierungswinkels 0. Prinzipiell ist 
durch Ermittlung des Winkels, den ausgezeichnete Objektradien mit den Achsen des 
Rasterfeldes bilden, eine Orientierungsbestimmung möglich. Von großer Genauigkeit 
und Robustheit ist beispielsweise die Berechnung des Winkels zwischen der Achse des 
kleinen Hauptträgermoments Tss und der jc-Achse des Rasterfelds, der aber nur mod 180° 
angebbar ist [7.27] [7.28]. Die erreichbare Genauigkeit ist neben der Streuung der Träg¬ 
heitsmomente auch vom Unterschied der beiden Hauptträgheitsmomente abhängig. Um 
die Mehrdeutigkeit zu eliminieren, können zusätzliche Winkel mit relativ geringer Ge¬ 
nauigkeit bestimmt werden, z. B. der Winkel, den der Vektor zwischen Flächenschwer- 
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punkt und Konturschwerpunkt mit der x-Achse bildet, der Winkel des Vektors zwischen 
Flächenschwerpunkt und Lochschwerpunkt sowie der jc-Achse usw. Eine weitere Me¬ 
thode beruht auf der Teilebeschreibung mit Radialschnitten. Vom zu erkennenden Teil 
wird gemäß Bild 7.38 ein Radialprofil in justierter Orientierung aufgenommen. Das 
Radialprofil besteht aus Strecken vom Flächenschwerpunkt {Sx, Sy) zu den Schnittstellen 
der Radien mit der Kontur. Die Radien sind auf einer vorgegebenen, meist gleichmäßigen 
Winkelteilung angeordnet. Zur Ermittlung des Orientierungswinkels wird in der Er¬ 
kennungsphase das gemessene Radialprofil so lange gegenüber dem Modellprofil ver¬ 
schoben, bis maximale Übereinstimmung herrscht. 




Bild 7.38. Onentienwgsbestimmung mit Radialprofil 

Die erreichbare Genauigkeit hängt dann von der Winkelteilung des Profils ab. Das 
Radialprofil wird ebenfalls für die Erkennung der Objekte eingesetzt. 



Bild 7.39 

Methode der polaren Kodierung 


Ein aus dem Radialprofil abgeleitetes, algorithmisch schnell zu realisierendes Verfah¬ 
ren benutzt das Prinzip der polaren Kodierung [7.29]. Um den Flächenschwerpunkt wird 
gemäß Bild 7.39 ein Kreis Kq mit dem Radius R gelegt. Das Objekt wird dann mit einer 
Kreisschar mit Mittelpunkten auf Kq und gleichem Radius R abgetastet; diese Kreise 
schneiden alle den Flächenschwerpunkt. Für jeden Kreis Ki wird die Anzahl der Objekt¬ 
bildpunkte aufgenommen. Das erhaltene Profil wird mit dem Referenzprofil verglichen 
und die Orientierung bestimmt. 

Sind die zu erkennenden Teile so beschaffen, daß sie durch die Wirkung eines mecha¬ 
nischen Anschlags nur eine geringe Zahl stabiler Vorzugsorientierungen annehmen, kann 
die Orientierungsbestimmung häufig auf eine Lageerkennung zurückgeführt werden. Das 
Prinzip kann insbesondere bei Flachteilen vorteilhaft angewendet werden [7.30]. 
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Entsprechend Bild 7.40 werden die Teile auf einem Transportband oder einer Transla¬ 
tionseinheit an einem Anschlag ausgerichtet; nach Freigabe der Bewegung (Heben des 
Anschlags) wird durch die Erkennungseinheit der Flächenschwerpunkt ermittelt und 
durch einfache Vergleichsverfahren mit den Referenzdaten der möglichen Vorzugsorien¬ 
tierungen sowohl eine vereinfachte Erkennung als auch die Bestimmung der eingenom¬ 
menen Orientierung durchgeführt. Die Referenzdaten müssen für jede Vorzugsorientie¬ 
rung in der Lernphase eingegeben werden. 

stabile Lagen 

Bild 7.40. Ausrichtung von Flachteilen an einen Anschlag 



Für Erkennungsaufgaben mit festen Orientierungen der Objekte läßt sich auch ein ein¬ 
faches Verfahren zum vollständigen Mustervergleich des Objekts (matching) mit dem 
Modellobjekt aufbauen, da nur Translationen zur Herstellung der optimalen Überdek- 
kung aller Zeileninhalte notwendig sind. 

Mustervergleichsverfahren dienen neben der Erkennung insbesondere der Qualitäts¬ 
überwachung, da mit ihnen jede Objektabweichung registriert und bewertet werden kann. 
Hierzu ist die vollständige Abspeicherung eines Repräsentanten der jeweiligen Objekt¬ 
klasse erforderlich. Beim Mustervergleich der Silhouetten, auch Schablonenvergleich 
(template matching) genannt, wird praktisch jeder Bildpunkt als Objektmerkmal aus¬ 
gewertet. 


Bild 7.41 

Fotografie einer durch Seitenlicht aufgehellten Kontur 



Die optische Erkennung und Bewertung einzelner Werkstückstrukturen (Kanten, 
Schweißfugen, Grat, Werkstückfehler) erfordert i. allg. aus technologischen Gründen die 
Anwendung der Auf- oder Schräglichtmethode und damit eine Grauwertverarbeitung des 
Rasterbilds. Das Problem besteht darin, aus häufig recht komplizierten Grauwertüber¬ 
gängen an den Objektstrukturen auswertbare Schwarzweißübergänge zu erzeugen, die 
mit der gesuchten Struktur am besten übereinstimmen. Die günstige Anordnung der Be¬ 
leuchtung unter den konkreten technologischen Bedingungen ist hierfür eine wichtige 
Voraussetzung. 
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Die Folge einer Bildverarbeitung vom Grauwertbild bis zur Darstellung und Bewer¬ 
tung der Kantenstruktur nach Roesler [7.31] wird im Bild 7.42 gezeigt. 


.. 15BFFFFFFfF .15BIi'FFFFFl''F .65555555 

.. 5ABFFFFFFFF .5994.65. 

.. 5A£!FFFFFFFF .5741.7. 

.. 5ABFFFFFFFF .5741... 7 .... 

. 17CFFFFFFFFF .17951.7. 

. 17CFFFFFFFFF .16641.7. 

.16BSFFFFFFFF .I6651.7. 

.. 5BBFFFFFFFF .5751.7. 

..4BFFFFFFFFF .4741.7. 

. . 4BFFFFFFFFF .4861.7. 

.. 59EFFFFFFFF .5961.8. 

... 8EFFFFFFFF .8B61.8. 

.. .59BFFFFPFF .57B95.8. 

... 256CFFPFFF .2249B61.18. 

...I2549EFFFF .12116A65.7. 

.... 25549CFFF .21.1553.7. 

....25469CFFF .2115535.7. 

... 15569GFFFF .15355665.7. 

...1558ACFFFP .1153453.7. 

...1568BEFFFF .1245345.6. 

,.14668CFFFFF .14552441.655. 

.159DFFFFFFFF .15899973.6. 

.59DFFFFFFFFF .58862.6. 

1 59BFFPFFFFFP .15452 .7. 

159SFFFFFFFFF .14451.. ••••«.•7. 


a) 


b) 


c) 



Bild 7.42. Folge einer Bildverarbeitung bis zur Bewertung des im Bild 7.41 enthaltenen Objekts durch 
morphometrische Merkmale nach Roesler [7.31] 

a) Ausschnitt des digitalisierten Grauwertbildes, dessen 16 Graustufen durch Hexadezimalzahlen dargestellt sind 

b) Detektion der optischen Kante aus dem Grauwertbild durch einen Gradin-Operator (Tafel 7.2) - die Kante wird durch ein 
Grauwertgebirge dargestellt 

c) Spur der optischen Kante, die durch einen Verfolgungsoperator erzeugt wurde - die Spur wird durch eine Folge von Free¬ 
manschen Richtungszahlen, einer Freeman-Kette, kodiert, und die Freeman-Zahlen 1 bis 8 bezeichnen die acht möglichen 
Nachbarpunkten gehörenden Richtungen 

d) die Freeman-Kette beschreibt eine geordnete und dichte Punktfolge, die nach einer Geradenapproximation durch einen 
Polygonzug dargestellt wird - Abweichungen von einer Sollgeraden können durch Merkmale bewertet werden 


Aus dem digitalisierten Grauwertbild (b) wird durch Anwendung des Gradin-Opera- 
tors (Tafel 7.2) ein Grauwertgebirge in der Übergangszone erzeugt (c). Mit Hilfe des 
Konturfolgeoperators wird hieraus eine Spur ausgewählt, die den geringsten Abweichun¬ 
gen in den Bildzeilen folgt; diese wird als Kette von Freemanschen Richtungszahlen 
kodiert. Gleiche Zahlen in der Kette bedeuten, daß in der darunterliegenden Zeile die 
Spur ihre Richtung beibehält; Richtungsabweichungen werden durch Zahlen von 1 bis 8 
dargestellt. 

Mit den Freemanschen Richtungszahlen ist dann eine Geradenapproximation mög¬ 
lich, die die Kurvenbeschreibung auf je einen Punkt für ein Geradenstück (beim ersten 
Geradenstück zwei Punkte) reduziert (d). Wird die Erkennung zur Qualitätssicherung 
benutzt, kann die Strukturabweichung durch Vergleich mit einer Referenzstruktur (im 
Bild als Gerade dargestellt) durch weitere Merkmale bewertet werden. 

Abschließend wird anhand vorgegebener Qualitätsmerkmale geprüft, ob diese im 
Toleranzbereich liegen. 


17 Industrierobotersteuerung 
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Die ermittelten Konturdaten können auch direkt zur Manipulatorsteuerung benutzt 
werden. In [7.32] ist eine Pilotlösung beschrieben, bei der die Schweißnahtverfolgung und 
Steuerung des Schweißprozesses direkt nach visuell ermittelten Konturdaten erfolgen. 

7.4.4. Visuelles System zur Teileerkennung und Lagebestimmung 

Bei der Realisierung visueller Erkennungssysteme wird in der Regel ein Kompromiß zwi¬ 
schen Funktionsumfang, Bedienungskomfort, Universalität einerseits sowie dem hierzu 
erforderlichen Aufwand und damit Preis andererseits zu schließen sein. Wichtige Krite¬ 
rien für den praktischen Einsatz visueller Erkennungssysteme sind der Umfang des zu 
erkennenden Teilesortiments, die Größe der Abweichungen der Teile untereinander, der 
Wechsel von Teilesortimenten (Änderung der Aufgabe) sowie die vorliegenden technolo¬ 
gischen Möglichkeiten. Ist beispielsweise im technologischen Prozeß ein Teiletransport 
sowieso notwendig, läßt sich eine Zeilenkamera i. allg. mit geringerem Aufwand installie¬ 
ren als eine Matrixkamera. Zu beachten sind außerdem die Bedingungen für eine günstige 
Beleuchtungstechnik sowie aus der vorhergehenden Bearbeitungsstufe resultierende Stör¬ 
einflüsse (Verschmutzungen, Späne, Kühlmittelfilm). 

Visuelle Erkennungssysteme mit Zeilen- und Matrixkamera unterschiedlichen Auf¬ 
lösungsvermögens und Funktionsumfangs werden seit einigen Jahren industriell pro¬ 
duziert und praktisch eingesetzt [7.34] [7.35] [7.36]. Für die Vorverarbeitung, Merk¬ 
malsbildung und Klassifikation sind neben Spezialhardware Klein- und Mikrorechner 
verschiedener Konfigurationen vorgesehen. Derzeit mit hoher Erkennungssicherheit be¬ 
herrschte Aufgaben sind folgende: 

Sortieren und Beschicken 

Unterschiedliche Teile werden in der Regel vereinzelt auf einem Transportband unter 
einer Kamera vorbeigeführt und nach der Erkennung der Teileklasse, der Position und 
Orientierung von einem IR in der ermittelten teilespezifischen Greifposition gegriffen und 
in der für das Teil erforderlichen Position abgelegt. Das Greifen erfolgt dabei sowohl bei 
gestopptem als auch bei bewegtem Transportsystem. 

Ermittlung von Konturverläufen und Werkstückfehlern 

Die erreichbare Genauigkeit der bereits beschriebenen Verfahren hängt dabei wesentlich 
von der beleuchtungsbedingten Art der Silhouettenbildung und dem Auflösungsvermö¬ 
gen der Kamera ab. 

Bestimmung von Relativpositionen 

Ein wichtiges Anwendungsgebiet ist hier die Montage; durch die Erkennung von gefor¬ 
derten Montagepositionen kann der Aufwand in der Peripherie verringert werden. Beispiele 
sind das Beschicken elektronischer Leiterplatten und Einlegearbeiten. 

Ein weiteres wichtiges Einsatzgebiet zukünftiger Erkennungssysteme ist die visuelle 
Inspektion von Werkzeugen für bedienerlose oder bedienarme Fertigungsprozesse. Durch 
Erkennung von Werkzeugbruch und -abnutzungsgrad muß hier Nachfolgeschaden ver¬ 
mieden werden. Die Vielfalt auftretender Verschleißerscheinungen und ihre Bewertung 
bedingen komplizierte Verarbeitungsverfahren und umfangreiches Modellwissen zur 
objektiven Entscheidung über die weitere Verwendbarkeit von Werkzeugen, für die auch 
der Bediener oft langjährige Erfahrung benötigt. 

Nachfolgend wird eine Pilotlösung vorgestellt, in der ein visuelles Erkennungssystem 
auf der Basis einer Zeilenkamera und eines 8-bit-Mikrorechners mit einem IR ZIM 10 
zum Sortieren von Werkstücken gekoppelt wurde. Die Hardwarekonfiguration wird im 
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Bild 7.43 gezeigt. Als Bildwandler dient die CCD-Zeile L 110 [7.17]; weitere Bestandteile 
der Kamera sind die Takterzeugung, die Steuerung der Binarisierungsschwelle und der 
Integrationszeit im Bildwandler zur Einstellung der optimalen Empfindlichkeit und des 
Auflösungsbereichs der Amplituden (s. Abschn. 7.4.1.) sowie eine Hardwarelösung zur 
Erzeugung des Run-length-Kodes [7.37]. 

Die Teilebeleuchtung erfolgt mittels Streifenschräglichts; als Beleuchtungsquellen die¬ 
nen Halogenstablampen in Verbindung mit Kunststoffzylinderlinsen. Mit dieser Be¬ 
leuchtungstechnik wird ein guter Kontrast auch bei geringen Reflexionsfaktordifferenzen 
zwischen Werkstück und Auflage erreicht, so daß eine Binärbild Verarbeitung vorgenom¬ 
men werden kann. Die Werkstücke werden auf einer linearen Verfahreinheit unter der 
Kamera vorbeibewegt. Die Binärbilddaten gelangen über einen Multiplexer in den 
Mikrorechner und werden zwischengespeichert. In einem ersten Verarbeitungsschritt 
wird durch ein Bildrahmenprogramm getestet, ob das Binärbild vollständig im jc-y-Raster 
enthalten ist, d.h., es dürfen keine Schwarzweißübergänge an den äußeren Punkten des 
Rasters auftreten. Weitere RAM-Speicher sind zur Abspeicherung der Repräsentanten 
der Teileklassen (Schablone) und für die Erkennungs- und Schablonenvergleichsalgo¬ 
rithmen vorgesehen. 



Die Programmstruktur wird im Bild 7.44 gezeigt. Für den Erkennungsprozeß sind drei 
Phasen charakteristisch: 

In der Trainingsphase erfolgt die Belehrung des Systems durch Vorzeigen je eines Ver¬ 
treters des gesamten Teilesortiments; es werden die Merkmale bestimmt und für den 
Schablonenvergleich ein Repräsentant abgespeichert. 

In der Prüfphase können unter Führung des Bedieners Programme zur Merkmalsbil¬ 
dung und Klassifikation ausgewählt und modifiziert werden. 
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7 . Sensoren 


In der Arbeitsphase erfolgt die Datenübergabe an die Robotersteuerung. 

Das Erkennungssystem enthält Module zum Mustervergleich, zur Teileklassifizierung 
und zur Orientierungsbestimmung, die einheitlich in die Blöcke Trainings-, Prüf- und 
Arbeitsphase gegliedert sind. Für die Trainings- und Prüfphase ist der Anschluß eines 
Bildschirmgeräts vorgesehen. Die Programme sind in ein Betriebssystem eingebettet, das 
eine Führung des Bedieners gestattet. 

Der vollständige Mustervergleich ist für Teile geeignet, die durch Ausrichtung an 
einem Anschlag nur einige Orientierungen einnehmen können. Die Schwarzweißüber¬ 
gangsbilder dieser Orientierungen werden von allen Teilen in der Trainingsphase gespei¬ 
chert. In der Arbeitsphase werden durch Schwerpunktzentrierung von Bild und Reprä¬ 
sentant das Teil erkannt, seine Orientierung und die Flächenschwerpunktkoordinaten 
bestimmt. 

Die Teileklassifizierung arbeitet mit morphometrischen Merkmalen; für die Klassifi¬ 
kation wird ein Entscheidungsbaum verwendet. Die Orientierungsbestimmung erfolgt 
nach der Teileklassifikation durch Richtungsmerkmale (Trägheitsmomentachsen, Vek¬ 
toren zu Konturpunkten usw.). Durch den Bediener wird aus diesen Modulen eine der zu 
lösenden Erkennungsaufgabe adäquate Auswahl getrolfen. 


Betriebssystem 


Auswahlprogramm 


1- 

: - 1 

1 

! 

1 

Abtastung eichen 


Kalibrierung 



Mustervergleich 


Orientierungsbestimmung 


Teileklassifizierung 

1 r 

— ',-' 

1 1 




1 1- 

\ \ -1 

Kassettenprogramm 

Trainingsphase Prüfphase Robotertraining 


1 

1 

1_ 

_1_1 

1 

Arbeitsphase 

[ 1 

Abtasten 

1 1 


Bild 7.44. Modulares Programmsystem der Erkennungseinheit nach Bild 7.43 


Weitere Programmteile dienen der Eichung der Kamera, der Abtastung sowie der Ein¬ 
stellung eines quadratischen Rastermaßes (gleiche Bildpunktabstände in x- und jj^-Rich- 
tung bei bewegtem Teil). 

Der Modul Kalibrierung realisiert die Transformation der Bildkoordinaten in das kar¬ 
tesische Basiskoordinatensystem des Roboters. Da die z-Koordinaten unverändert blei¬ 
ben, sind nur die variablen x- und j-Koordinaten sowie ein Orientierungswinkel für das 
jeweils erkannte Teil an die Robotersteuerung zu übergeben. Die Trainingsphase be¬ 
inhaltet auch das Teachen der Greiferstellung des IR. Von der Robotersteuerung werden 
die (jc, >^)-Koordinaten des Greifpunktes und der Orientierungswinkel im Basiskoordina¬ 
tensystem übergeben. Mit vom Erkennungssystem ermitteltem Flächenschwerpunkt und 
Orientierungswinkel des Teiles werden der Abstand des Greifpunktes vom Schwerpunkt 
und der Winkel zwischen der Greiferorientierung und Teileorientierung ermittelt und im 
Erkennungssystem gespeichert. In der Arbeitsphase werden an die IR-Steuerung die 
Teileklasse, die aktuellen (x, >^)-Koordinaten des Greifpunktes und der aktuelle Winkel 0 
in Basiskoordinaten übergeben; die Verschiebung durch das Transportsystem wird dabei 
verrechnet. Die Teileklasse dient dem Aufruf des für das Teil spezifischen Unterprogramms 
zur Ablage auf einer Palettenposition. Der Datenaustausch zwischen Erkennungssystem 
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und Robotersteuerung erfolgt über eine serielle Standardschnittstelle. Die erreichten Er¬ 
kennungszeiten liegen unter einer Sekunde. 

Das beschriebene Erkennungssystem wurde im Zentralinstitut für Kybernetik und Tn- 
formationsprozesse der AdW entwickelt; die Pilotlösung wurde durch ein gemeinsames 
Forschungskollektiv der AdW, des VEB Zentraler Ingenieurbetrieb der Metallurgie 
(ZTM) und des Werkzeugmaschinenkombinats „7. Oktober“ realisiert. 


7.4.5. 3-D-Erkeimung 


Die fehlende Tiefeninformation wird bei der 2-D-Erkennung durch Einschränkungen der 
zulässigen Parametervariation und des erkennbaren Teilesortimentes ersetzt. 

Tiefeninformation kann auch mit 2-D-Erkennungssystemen durch Verwendung struk¬ 
turierten Lichtes oder Ausnutzung der Perspektive gewonnen werden. 

Wird durch einen Projektor ein Parallelstrahl erzeugt, der nicht in der optischen Achse 
des Bildaufnahmesystems liegt, so kann aus dem Abbildungsort des von einem Objekt 
reflektierten Bildpunktes auf dessen Entfernung geschlossen werden (Triangulation). 

Die Ausnutzung der Perspektive ist möglich, wenn eine größenunabhängige Teile¬ 
erkennung durchgeführt wird und durch Vergleich von Abständen markanter Punkte des 
Objekts mit denen des gespeicherten Repräsentanten die Veränderung des Abbildungs¬ 
maßstabs bestimmt wird. Beide Verfahren rechnen zu den sog. 2^-D-Systemen [7.39]. 



Bild 7.45 

3-D-Abtastung eines Objekts 
mittels Laserstrahls 


Eine echte 3-D-Erkennung erfordert entweder den Einsatz von zwei Kameras und 
Triangulation der Bildpunkte oder die Messung des vom Licht zwischen Reflexionspunkt 
und Kamera zurückgelegten Weges über eine Laufzeitmessung. Das Prinzip der Laufzeit¬ 
messung ist im Bild 7.45 dargestellt. Eine Laserlichtquelle sendet amplitudenmoduliertes 
Licht auf einen in zwei orthogonalen Richtungen drehbaren Spiegel mit senkrecht zu¬ 
einander angeordneten Reflexionsflächen. Im Empfänger wird mittels eines Phasen¬ 
detektors die Laufzeit bestimmt. Die Stellung des Drehspiegels bestimmt die Lage des 
Bildpunktes im Raster; aus der Laufzeit kann bei Berücksichtigung der Spiegelstellung die 
Entfernung des Objekts ermittelt werden. 

An der Realisierung praktisch einsetzbarer 3-D-Erkennungssysteme wird intensiv ge¬ 
arbeitet. Dies betrifft sowohl die Verbesserung der Bildaufnahmetechniken als auch die 
Methoden der Auswertung. Die Erkennungszeiten für ein 3-D-Datenmassiv sind derzeit 
noch so groß, daß ein Echtzeitbetrieb nicht möglich ist. 







8 . 


Industrielle Steuereinrichtungen 


8.1. Allgemeines 

In diesem Kapitel werden Industrierobotersteuerungen beschrieben, die aus dem 
System 600 und dem System ursalog 5000 hervorgegangen sind. Beide bauen auf ein 
standardisiertes Mikrorechnersystem auf. 

Das System 600 des VEB Numerik „Karl Marx“ ist auf die Belange der Werkzeug¬ 
maschinenindustrie orientiert; zwei aus diesem System abgeleitete Varianten stellen reine 
Industrierobotersteuerungen dar. 

Aus dem System ursadat 5000 des VEB EAW Berlin ist eine Steuerung entstanden, die 
insbesondere für im direkten Teach-in programmierbare Roboter geeignet ist. 

Moderne industrielle Steuereinrichtungen werden heute fast ausschließlich unter Ver¬ 
wendung von einem oder mehreren Mikrorechnern realisiert. Ausnahmen bilden kleine 
Ablaufsteuerungen, deren Funktionsumfang durch Verbindungsprogrammierung fest¬ 
gelegt wird [8.26]. Die Anwendung von Mikrorechnern hat den Systemgedanken bei der 
Entwicklung von industriellen Steuereinrichtungen stark geprägt. Dies gilt sowohl für die 
Konfigurierung eines Systems aus Hardwarekomponenteh als auch für die Erstellung der 
innen, das Funktionalverhalten bestimmenden Software. In der DDR wird für industrielle 
Steuereinrichtungen der derzeitigen Generation im wesentlichen das vom VEB Kombinat 
Robotron gefertigte Mikrorechnersystem Kl520 eingesetzt. Dieses umfaßt neben den 
Rechner- und Speicherbaugruppen eine Reihe von Anschlußeinheiten für datenverarbei¬ 
tungstypische periphere Geräte. Für Steuereinrichtungen werden weitere, prozeßtypische 
Anschlußeinheiten benötigt, die die Kommunikation mit dem zu steuerndeh oder zu 
regelnden Prozeß durchführen. 

Diese Lücke schließt das System ursadat 5000 des VEB EAW Berlin mit seinen An¬ 
schlußeinheiten für analoge und binäre Signalverarbeitung. Diese vor allem unter dem 
Aspekt der Störsicherheit für den Industrieeinsatz entwickelten Baugruppen arbeiten 
ebenfalls auf den standardisierten K1520-Bus. Für Steuerungen, bei denen spezielle, nicht 
im Angebot eines Systems befindliche Anschlußeinheiten benötigt werden, sind diese 
unter Beachtung der Busparameter vom Steuerungshersteller selbst zu entwickeln und zu 
fertigen. 


8.2. Mikrorechnersystem Kl520 

Das Mikrorechnersystem Kl 520 basiert auf dem Mikroprozessorschaltkreis U880 
(CPU), dem Schaltkreis für parallele Ein- und Ausgaben U855 (PIO), dem seriellen Ein¬ 
gabe- und Ausgabeschaltkreis U856 (SIO) und dem Zähler-Zeitgeber-Baustein U857 
(CTC). Diese in n-Kanal-Silicon-Gate-Technologie hergestellte Schaltkreisfamilie kann 
der dritten Generation von Mikroprozessoren zugeordnet werden. Als Festwertspeicher 
wird der Schaltkreis U555 (1 KByte EPROM) eingesetzt, während als Operativspeicher 
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Tafel 8.1. Komponenten des Mikrorechnersystems Kl520 


Bezeichnung 

Kurzbe¬ 

zeichnung 

Chiffre 

Hauptparameter 

Zentrale Rechen¬ 
einheit 

ZRE 

K2521 

K2522 

K2523 

K2524 

K2525 

Mit: CPU-Schaltkreis U880 (Taktgenerator) 

PlO-Schaltkreis U855 (Anfangsinitialisierung 
nach Spannungszuschaltung) 

CTC-Schaltkreis U857 

1 KByte statisch RAM 
bis 3 KByte EPROM (U555) 

Koppelelektronik für Mehrrechnerbetrieb 

Wie K2521, ohne Taktgenerator/Anfangs¬ 
initialisierung 

Wie K2521, ohne CTC-Schaltkreis 

Wie K2522, ohne CTC-Schaltkreis 

Mit: CPU-Schaltkreis U880 (Taktgenerator) 

CTC-Schaltkreis U857 (Anfangsinitialisierung 
nach Spannungszuschaltung) 

8 KByte EPROM (U555) 

Operativspeicher 

j 

OPS 

K3520 

K3521 

K3525 

nMOS-RAM 4 KByte statisch RAM 

CMOS-RAM 4 KByte statisch RAM 
(batteriegestützt) 

nMOS-RAM 16 KByte dynamisch RAM 

Operativ-/ 

Festwertspeicher 

OFS 

K3620 

nMOS-RAM 2 KByte statisch RAM, bis 6 KByte 
EPROM 

Festwertspeicher 

PFS 

K3820 

bis 16 KByte EPROM 

Anschlußsteuerung 
für Folienspeicher 

AFS 

K5121 

Anschluß bis zu 4 Floppy-Disk-Laufwerken des 
Typs MF 3200 

Anschlußsteuerung 
für Lochbandgeräte 

ADA 

K6022 

Anschluß von Geräten mit SIF 1000 im KME-Pegel 
1 Eingabekanal, 1 Ausgabekanal 

Anschlußsteuerung 
für Lochbandgeräte 

ALB 

K6025 

Anschluß der Lochbandeinheit K6200 (SKR- 
Interface) 1 Eingabekanal, 1 Ausgabekanal 

Anschlußsteuerung 
für Kassetten¬ 
magnetbandgerät 

AKB 

K5020 

Anschluß von 2 Kassettenmagnetbandgeräten 

K5200 oder der Kassettenmagnetbandstation 

K5221 

Anschlußsteuerung 
für Bildschirm 

ABS 

K7023 

Anschluß des Bildschirmmonitors K7221 

Anschlußsteuerung 
für Interface S 2 

ASV 

K8021 

Anschluß von 2 duplexfähigen Kanälen nach 
CCITT-V24 

Anschlußsteuerung 
für Tastatur und 
2kanaliges serielles 
Interface 

ATS 

K7028 

Anschluß einer Tastatur über gerätenahes Interface 
nach KROS-R5103 (Realisierung der Bedingungen 
des IFSS mit 20-mA-Stromschleife und Interface S2 
nach CCITT-V24) 

Anschlußsteuerung für 

EPROM-Programmier- 

einrichtung 

PPE 

K0420 

Anschluß der EPROM-Aufnahmeeinrichtung 

PAE K0422 für die Programmierung des Schalt¬ 
kreises U555 

Anschlußsteuerung für 
die Bedieneinheit 

ABD 

K7022 

Anschluß der Bedieneinheit BDE K2622 zur In¬ 
betriebnahme, Wartung, Fehlersuche und Pro¬ 
grammtestung 
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Tafel 8.1 (Fortsetzung) 


Bezeichnung 

Kurzlje- 

zeichnung 

Chiffre 

Hauptparameter 

Anschlußsteuerung für 
Seriendrucker, Tastatur 
und alphanumerischer 
Kleinanzeige 

ATD 

K7026 

Anschluß des Seriendruckers SD 1 /SD 2 mit GNI, 
einer Einheitstastatur K7602 ... K7606 bzw. K7632 
bis K7636 sowie einer alpha-numerischen Klein¬ 
anzeige ANK K7521 

Busverstärker 

BVE 

K4120 

Verstärkung und Entkopplung der Bussignale, 
ermöglicht die Verlängerung von System- und 
Daten-Koppelbus 

Steckeinheiteneinsatz 

STS 

KO 120 

K0121 

Baugruppeneinsatz zur Aufnahme von Steck¬ 
einheiten mit indirekten Steckverbindern, einbau¬ 
fähig in Gehäuse des EGS, bis 480 mm aufreihbar 
Format der Steckeinheiten: 215 x 170 mm^ 

Einsatz für 5 Steckeinheiten, 120 mm breit 

Einsatz für 11 Steckeinheiten, 240 mm breit 


statisch wie auch dynamisch arbeitende RAM-Schaltkreise Verwendung finden. Weitere 
Zusatzschaltkreise dienen zur logischen Anpassung der Systemschaltkreise untereinander 
und der Entkopplung der Anschlußeinheiten vom Bus und zum Anwender hin. Der Be¬ 
fehlssatz des Mikroprozessorschaltkreises U880 enthält 158 Basisbefehle und ist Grund¬ 
lage der Assemblersprache SYPS K1520; er kann u.a. aus [8.27] [8.28] entnommen wer¬ 
den. Mit der Einheitsbaureihe der Stromversorgungsbaugruppen [8.29] steht ein Typen¬ 
sortiment von Schaltnetzteilen einschließlich Steuerbaugruppen zur Netz- und Zuschalt¬ 
folgesteuerung zur Verfügung, das den Aufbau von Stromversorgungseinheiten für be¬ 
liebig konfigurierte Mikrorechner erlaubt. 

In Tafel 8.1 sind die Komponenten des Mikrorechnersystems Kl520 zusammengestellt. 
Für industrielle Steuerungssysteme werden im wesentlichen nur die zentrale Rechen- 
einheit(en) und die Speicherkarten eingesetzt. Die Anschlußeinheiten für die datenver¬ 
arbeitungstypischen Geräte werden relativ selten verwendet. Sofern sie in einer in den 
Folgeabschnitten beschriebenen Steuereinrichtung Anwendung finden, wird an diesen 
Stellen näher auf sie eingegangen. 

Die zentrale Recheneinheit (ZVE) stellt die wichtigste Baugruppe im Mikrorechner¬ 
system Kl520 dar. Sie kann als Einplatinenrechner (außer K2525) betrieben oder als zen¬ 
trale Steckeinheit an den K1520-Bus angeschlossen werden. Tn ihrer Grundvariante ent¬ 
hält sie den Prozessorschaltkreis, einen Schaltkreis zur parallelen Ein-/Ausgabe und einen 
Zähler-Zeitgeber-Baustein. Neben Zusatzschaltkreisen, z.B. zur Busentkopplung, be¬ 
finden sich Schreib-Lese-Speicher (statisch RAM) mit einer Speicherkapazität von ein 
KByte und drei Steckfassungen zur Aufnahme von programmierbaren Festwertspeichern 
U555 auf dieser Karte. Ein quarzstabilisierter Taktgenerator sorgt für einen Systemtakt¬ 
zyklus von 407 ns, während die Rücksetzschaltung den Programmstart nach Zuschalten 
der Versorgungsspannungen ab der Initialadresse 0000 H gewährleistet. Die Arbeitsweise 
der ZVE wird durch die in den Speichern abgelegten Befehlsfolgen bestimmt. Ein im 
Prozessorschaltkreis befindlicher Zähler (Programmzähler/Befehlszähler) ruft, von der 
Tnitialadresse beginnend, in stetiger Folge die vom Programmierer festgelegten und sich 
im Speicher befindlichen Befehle und Daten ab. Die Befehle werden vom Prozessor als 
Anweisungen über sein Verhalten (Befehlsabarbeitung) interpretiert, während die Daten 
zur eigentlichen Auslösung von Steuerreaktionen herangezogen werden. Nähere und ins 
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Detail gehende Erläuterungen über die Arbeitsweise von Mikrorechnern können aus 
[8.27] entnommen werden. 

Der relativ geringe Speicherumfang auf der zentralen Recheneinheit erfordert in den 
meisten Fällen eine Speicherraumerweiterung. Dazu dienen die Baugruppen Festwert¬ 
speicher (PFS), Operativ-Festwert-Speicher (OFS) und Operativspeicher (OPS). Die 
Kartenbaugruppe PFS erlaubt die Erweiterung bis zu 16 BKyte EPROM U555, während 
die Karte OFS eine Kombination von 2 KByte statisch RAM und bis zu 6 KByte EPROM 
darstellt. Die Operativspeicherleiterkarten gestatten eine Erweiterung um 1 KByte (dyna¬ 
misch RAM) und 4 KByte (statisch RAM). Bei der letzteren gibt es eine Bestückungs¬ 
variante mit CMOS-Speichern, die aufgrund ihres geringen Energieverbrauchs durch 
Batteriestützung auch bei abgeschalteter Anlage (^ 200 h) ihren Inhalt nicht verlieren. 



gerät /<5200 Monitor k 7221 

Bild 8.1. Beispiel einer Mikrorechnerkonfiguration Kl520 

Bild 8.1 zeigt an einem Beispiel den Anschluß der Komponenten des Mikrorechners an 
seinen Bus. Der K1520-Bus wird durch zwei Bündel von Leitungen gebildet. In der ersten 
Gruppe sind alle die für den Systemaufbau wesentlichen Leitungen einschließlich der der 
Stromversorgung zusammengefaßt. Sie dienen zur Kommunikation der ZVE mit den 
Speicher- und Eingabe-Ausgabe-Baugruppen und werden als Systembus bezeichnet. Der 
Koppelbus stellt die zweite Gruppe dar und dient u.a. der Kopplung mehrerer Mikro¬ 
rechner Kl 520. Konstruktiv sind jeder Steckeinheit zwei 58polige Steckverbinder zu¬ 
geordnet, wobei eine Steckverbindung in die gedruckte Rückverdrahtung (Systembus) 
eingebunden ist, während die andere durch Wickelverbindungen zu beschälten ist. 
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8.3. System 600 

8.3.1. Übersicht 

Das System 600 des VEB Numerik „Karl Marx“ wurde in Zusammenarbeit mit dem 
Forschungszentrum des Werkzeugmaschinenbaus und den Werkzeugmaschinenkombi¬ 
naten der DDR entwickelt. Es stellt ein leistungsfähiges mikroelektronisches Steuerungs¬ 
system dar, mit dem ein breites Spektrum von Steuerungsaufgaben gelöst werden kann. 
Das Grundkonzept beruht auf modularen Steckeinheiten, aus denen unterschiedliche 
Steuerungstypen konfiguriert Werden. Bild 8.2 gibt einen Überblick über die gefertigten 
Steuerungstypen des Systems 600. Danach werden 

- numerische Steuerungen (NC), die aufgrund der verwendeten Mikrorechnerbasis vom 
Typ CNC (computerized «umerical control) sind; 

- programmierbare Maschinensteuerungen (PC programmable control); 

- Industrierobotersteuerungen (IRS) 

unterschieden. 



CNC 600 

Modulares, universelles nume¬ 
risches Steuerungssystem für - 
bis zu 5 NC-gesteuerte Achsen, 
Schrankbau weise 

CNC 600-3 

Steuerungssystem für Ferti¬ 
gungszellen, direkt aus 
CNC 600 abgeleitet 

CNC-H 600 

Universelles numerisches Steue¬ 
rungssystem für bis zu 3 NC- 
gesteuerte Achsen, vorzugsweise 
zur Handeingabe von Program¬ 
men als einbaubare Kompakt¬ 
steuerung 


IRS 600 

Punkt-zu-Punkt-Steuerung für 
bis zu 3 NC-gesteuerte Achsen 
und indirektem Teach-in, vor¬ 
zugsweise für Handhabungs¬ 
und Beschickungsaufgaben 

IRS 650 

Bahnsteuerung für Industrie¬ 
roboter in Gelenkbauweise für 
technologische Grundopera¬ 
tionen, bis zu 6 NC-gesteuerte 
Achsen, indirektes Teach-in 


PC 600 

Modulares System für program¬ 
mierbare Maschinen- und 
Prozeßsteuerungen 


Bild 8.2. Übersicht über die Steuerungstypen des Sy.stems 600 


Steuerungen vom Typ CNC 600 werden vorzugsweise für Dreh-, Bohr- und Fräs¬ 
maschinen und zur Steuerung von Bearbeitungszentren eingesetzt (Bild 8.3). 

Die CNC-H 600 ist als Kompaktsteuerung ausgelegt und in das Hängetabelau der 
(Bohr- oder Fräs-) Maschine oder ins Maschinenverdeck der (Dreh-) Maschine einbau¬ 
bar (Bild 8.4). Die Steuerung ist für eine Handeingabe konzipiert, wobei besonderer Wert 
auf eine prozeßnahe, dialogunterstützte Programmierung vor Ort gelegt wurde. Die 
CNC-H 600 ist für maximal drei NC-gesteuerte Achsen ausgelegt und wird in drei Va- 








Bild 8.3 

DNC 600 an einer 
Werkzeugmaschine 
( Werkfoto 
VEB NKM) 


Bild 8.4. Gesamtansicht CNC-H 600 (Werkfoto VEB NKM) 


Bild 8.5. Gesamtansicht PC 603 (Werkfoto VEB NKM) 
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rianten hergestellt, die sich bezüglich der vorgesehenen Interpolationsart unterscheiden. 
Die speicherprogrammierbaren Steuerungen vom Typ PC 600 werden als autonome 
konstruktive und funktionelle Einheiten mit eigener Stromversorgung in Leistungsteil¬ 
schränke eingebaut (Bild 8.5). Die Grundvariante umfaßt 480 Prozeßein- und -ausgänge. 
Die Industrierobotersteuerungen IRS 600 und IRS 650 werden nachfolgend beschrieben. 

Alle Steuerungen des Systems 600 beruhen auf einem einheitlichen Systemkonzept. Die 
entsprechende Struktur ist dazu im Bild 8.5 dargestellt. Sie ist eine modulare Mehr¬ 
mikrorechnerstruktur mit hierarchischem Aufbau. 


Bedien - und 
Programmierperipherie 


übergeordneter 

Rechner 


Speichet] 

(RAM! 

EPRQM) 
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system- 
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Antriebs- Meß¬ 
steuerung Systeme 


Bild 8.6. Zum Grundkonzept System 600 

AS Anschlußsteuerung; Digital-Analog-Umsetzer 


Die Funktionen des Masters (Leitrechner) bestehen in der Koordinierung und Über¬ 
wachung des Gesamtsystems und der Kommunikation mit dem Bediener/Programmierer 
und dem übergeordneten Rechner. Dazu sind am Systembus des Masters neben dem 
Speicher, der das Betriebssystem enthält und gleichzeitig operativer Speicher für die 
Anwenderprogramme ist, geeignete Anschlußsteuerungen angeschlossen. 

Der Master verkehrt über einen Koppelbus mit maximal drei untergeordneten Rech¬ 
nern für die Bewegungssteuerung (Slave 1), für die Ausführung umfangreicherer nume¬ 
rischer Operationen (Slave 2) und für die Prozeßsteuerung (Slave 3). 
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Der Systembus von Slave 1 ist mit einem weiteren Bus gekoppelt, an den die Lage¬ 
regelungsrechner für die servogeregelten Achsen und die zugeordneten Meßeingänge und 
Stellausgänge angeschlossen sind. 

An den Systembus von Slave 3 ist eine Anschlußsteuerung zur Ein- und Ausgabe binä¬ 
rer Signale für die Prozeßsteuerung angekoppelt. Aufgrund der gewählten Architektur 
und eines weitgehend vereinheitlichten Baugruppensystems ist es möglich, die Hardware 
weitgehend auf die konkrete Steuerungsaufgabe zuzuschneiden. 

Eine detaillierte Beschreibung und wesentlicher Komponenten des Betriebssystems am 
Beispiel der Steuerung CNC 600 findet sich im Anhang. Bei den nachfolgend beschriebe¬ 
nen Industrierobotersteuerungen IRS 600 und IRS 650 handelt es sich um eine Einrech¬ 
ner- bzw. eine Zweirechner Variante, bei denen die mittlere Hierarchieebene aus Bild 8.6 
im wesentlichen entfällt und alle Komponenten an den Systembus des Masters angeschlos¬ 
sen sind. 


8.3.2. Industrierobotersteuerung IRS 600 

Die IRS 600 ist eine Industrierobotersteuerung, die vorwiegend für Handhabungs- und 
Beschickungsaufgaben geeignet ist. Sie ist eine Punkt-zu-Punkt-Steuerung mit maximal 
drei simultan NC-gesteuerten Achsen. Zusätzlich können zwei weitere Achsen als 
nockengesteuerte bzw. reine Schaltachsen betrieben werden, wobei eine davon stufenlos 
über D/A-Wandler-Ausgang ansteuerbar ist. 

Die NC-gesteuerten Achsen sind lagegeregelt. Es können direkt hydraulische Antriebe 
mit einem Strom im Bereich + 50 mA bzw. elektrische Antriebe mit einem Spannungs¬ 
signal im Bereich ± 10 V angesteuert werden. Zur Positionserfassung sind phasenzyklische 
Meßsysteme (Inductosyn, Resolver) anschließbar. Die Meßsystemauflösung beträgt 
0,01 mm bzw. 0,01°. Die Programmierung und Bedienung der Steuerung erfolgt über das 
am IRS-600-Schrank (600 mm x 600 mm x 1800 mm) einhängbare tragbare Teach-in- 
Tableau. Neben der Möglichkeit, Programme im indirekten Teach-in einzugeben, besteht 
auch die Möglichkeit der Programmeingabe mittels eines ansteckbaren Lochstreifenlesers 
(Typen FS 100 bzw. FS 330). Zur Lochbandausgabe kann ein Stanzer der Typen DT-105 S 
bzw. daro 1215 angeschlossen werden. 

Die Steuerung IRS 600 ist entwickelt und erprobt für den Industrieroboter IR 2/S2. 
Das betrifft Betriebs- und Diagnosesoftware sowie das in den Steuerschrank eingebaute 
Leistungsteil. Für Anwenderprogramme wird ein Speicherraum von 5 KByte CMOSRAM 
mit einer Stützzeit von mindestens 200 h zur Verfügung gestellt. 

Der universelle, modulare Charakter der Steuerung ermöglicht selbstverständlich die 
Steuerung anderer Roboter im Rahmen des beschriebenen Funktionsumfangs. Die maxi¬ 
male Anzahl von Prozeßeingangssignalen ist 136, von Prozeßausgangssignalen 96. 

8.3.2.1. Gerätetechnik 

Der innere Aufbau der Steuerung ist im Blockschaltbild (Bild 8.7) dargestellt. Zu wesent¬ 
lichen Teilen konstituiert sich die Steuerung aus Baugruppen des Systems Kl520 und 
universellen Baugruppen des Systems CNC 600. Die IRS 600 stellt ein Einrechnerkonzept 
dar. Zentraler Rechner ist die ZRE K2521, die den standardisierten K1520-Systembus 
bildet. 

Als Speicher für residente Programme wird zusätzlich die Baugruppe K3820 benutzt. 
Zwei CMOS-Steckeinheiten K3521 stellen einen Bereich von 8 KByte (batteriegestützt) 
zur Verfügung (Anwenderprogramme, LFnterprogramme, Generierdaten). Über die Bau- 
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gruppe DA 2, die 4 D/A-Wandler-Kanäle mit einer Breite von 8 Bit besitzt, werden die 
Antriebe der drei NC-gesteuerten Achsen sowie einer nicht NC-gesteuerten Achse an¬ 
gesteuert. Für die Direktansteuerung von Servoventilen wird ein Stromsignal im Bereich 
± 50 mA bei einem Lastwiderstand von 50 D erzeugt. Die Meßsystemansteuerung und 
Analogsignalverarbeitung erfolgen im Modul Ml (bei Inductosyn) bzw. M2 (bei Resol- 
ver). Die digitale Meßwertverarbeitung einschließlich der Bildung der Busschnittstelle zur 
Abfrage durch die ZRE befinden sich auf der je Meßachse einmal eingesetzten Steck¬ 
einheit ME 1. Der Lageregelungsalgorithmus wird im Rechner ausgeführt. 



Sicherheifs- Teach-in Roboter Beschickungsmaschinen 
Technik Tableau und -peripnerie 

Bild 8.7. Blockschaltbild der IRS 600 


statt D2 lies DA2 

Mit der Kartenbaugruppe Serviceeinheit (SE), die fester Bestandteil jeder Steuerung ist 
und eigene Bedien- und Anzeigeelemente besitzt, können Diagnoseroutinen angewählt 
und gestartet, Prozeßsignale ausgegeben bzw. abgefragt, Daten und Adressen angezeigt 
sowie Achsdaten generiert werden. Die Serviceeinheit besitzt zu diesem Zweck vier Ein¬ 
gabetasten, einen Wahlschalter, eine östellige 7-Segment-LED-Anzeige sowie acht 
Lumineszenzdioden. 

Die Steckeinheit Busergänzung hat spezifische Aufgaben, insbesondere Überwachungs¬ 
aufgaben zu lösen. Mittels der Anschlußsteuerung AS PEAS erfolgt die Verbindung vom 
Rechnersystembus zum PEAS-Bus, wie dies bei den bereits behandelten Steuerungen dar¬ 
gelegt wurde. 
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Der Anschluß des Teach-in-Tableaus erfolgt am PEAS-Bus über einen Multiplexer der 
Datenbreite 8-Bit-Eingabe und 16-Bit-Ausgabe. Das Tableau (Bild 8.8) beinhaltet eine 
programmierbare Anzeige, eine numerische Eingabe, eine Funktionstastatur zur Befehls¬ 
eingabe, 'Servicetasten, zwei Wahlschalter für Betriebsarten und Verfahrgeschwindigkei¬ 
ten sowie Not-Aus- bzw. Ausschalter. Es ist konstruktiv im Schutzgrad IP 54 ausgeführt. 



Bild 8.8. Teach-in-Tableau IRS 600 ( Werkfoto VEB NKM) 


Bild 8.9. Steuerschrank IRS 600 
mit Teach-in-Tableau ( Werkfoto VEB NKM) 



Am Schaltschrank selbst sind nur Hauptschalter, Taster für Steuerspannung, Hydraulik 
und Not-Aus-Schalter angebracht. Die Gesamtansicht der IRS 600 mit eingehängtem 
Teach-in-Tableau wird im Bild 8.9 gezeigt. Das Logikteil des Steuerschranks ist kon¬ 
struktiv modular auf der Basis von in Baugruppenträgern steckbaren Einheiten, die über 
eine gedruckte Rückverdrahtung verbunden sind, aufgebaut. Die Stromversorgung erfolgt 
auf der Basis von Moduln des Systems Kl 510. 


8.3.2.2. Programmsysteme und Programmierung 

Die zur IRS 600 gehörenden Programmsysteme unterteilen sich in resident in der Steue¬ 
rung auf EPROM abgelegte Programme und vom Anwender zu erstellende und auf 
CMOSRAM-Speicher abzulegende Ablaufprogramme. 

Die residente Software besteht aus den beiden Hauptkomponenten Manipulator¬ 
software und Steuerungsdiagnose. 


















































272 


8. Industrielle Steuereinrichtungen 


Die Manipulator Software setzt sich aus einem Betriebssystem und dem Manipulator¬ 
steuersystem zusammen. 

Hauptaufgaben des Betriebssystems sind dabei die Steuerung des Verkehrs mit der 
gesamten Eingabe-Ausgabe-Peripherie (Abfrage der Eingänge, Ausgabe an die Ausgänge, 
Bedienung von Leser und Stanzer sowie der Serviceeinheit), die Zeitorganisation, Unter¬ 
programmbehandlung und Programmaufrufe. 

Das Manipulatorsteuersystem organisiert die gerätespezifischen Funktionen des Robo¬ 
ters und der anschließbaren Zusatztechnik. Es wertet den Zustand der Bedienelemente 
des Teach-in-Tableaus aus und organisiert die entsprechenden Aktionen. Des weiteren 
überwacht es das Vorliegen von Fehlermeldungen bzw. nichtplausiblen Zuständen der 
Anlage und gibt entsprechende Fehlerkodierungen aus. 

Das ebenfalls residente Programmsystem zur Steuerungsdiagnose besteht aus zwei Tei¬ 
len. Der erste Teil ist die sog. Einschaltdiagnose, die bei jedem Einschalten der Steuerung 
durchlaufen wird und die die Hauptbaugruppen der Steuerung diagnostiziert. Ihr erfolg¬ 
reicher Durchlauf ist Voraussetzung für den Übergang in den eigentlichen Steuerungs¬ 
betrieb. Der zweite Teil umfaßt die einzelnen Baugruppen zugeordneten Diagnoserouti¬ 
nen, die, durch die Serviceeinheit aufrufbar, zur Fehlersuche im Off-line-Betrieb benutzt 
werden können. Dieser Teil des Diagnosesystems ist so konzipiert, daß ohne zusätzliche 
Meßmittel die defekte steckbare Einheit lokalisiert werden kann. Durch die residente 
Steuerungssoftware wird abgesichert, daß der Anwender der Steuerung nicht mit der 
eigentlichen Mikrorechnerprogrammierung in Berührung kommt. 

Die Aufgabe des Anwenders reduziert sich damit auf die Eingabe von Ablaufprogram’ 
men und Generierdaten mit den spezifischen Eingabemitteln der Steuerung (Teach-in- 
Tableau, Leser). Der Satzaufbau der Ablaufprogramme ist ähnlich denen von NC- 
Maschinen. Dadurch ergibt sich eine gute Überschaubarkeit des Ablaufs und eine ein¬ 
fache Inbetriebnahme. 

In den 5 KBytes umfassenden, gestützten RAM-Speicher können bis zu 99 Ablaufpro¬ 
gramme eingegeben werden. Jedes Ablaufprogramm ist eine Folge von maximal 99 NC- 
Sätzen. Die Länge eines Programms darf jedoch 1 KByte nicht überschreiten (bei Über¬ 
schreitung erfolgt Fehleranzeige). Die bis zu 99 adressierbaren Unterprogramme sind 
schachtelbar in acht Ebenen. Ihre Anwendung empfiehlt sich insbesondere unter den 
Aspekten Speicherplatz- und Programmierzeitoptimierung. 

Die Programmierung setzt eine Generierung der G-Befehle und der Variablen der 
M-Befehle voraus. 

Alle Details bezüglich der Programmerstellung und Generierung, der Korrektur von 
Programmen und Daten sowie der notwendigen Bedienhandlungen sind in der Bedien¬ 
anweisung des IRS 600 fixiert. Nachfolgend soll deshalb nur auf einige ausgewählte Pro¬ 
bleme eingegangen werden. 

Die Teach-in-Programmierung kann auf drei verschiedene Arten erfolgen; dabei ist 
eine Kombination dieser innerhalb eines Programms möglich. Es wird zunächst unter¬ 
schieden in die Teach-in-Programmierung ohne Ausführung von Achsbewegungen und in 
eine solche mit Ausführung von Achsbewegungen. Die erstgenannte Art entspricht einer 
Handeingabe aller Satzinformationen. Bei der Programmierung mit Achsbewegungen 
gibt es eine erste Variante, bei der alle Satzinformationen von Hand eingegeben werden, 
aber die Eingabe des Folgesatzes erst erfolgt, nachdem die Achsbewegungen des gerade 
eingegebenen Satzes ausgeführt und die Satzinformation in den Programmspeicher über¬ 
nommen wurden. Bei der zweiten Variante werden keine geometrischen Informationen 
von Hand eingegeben. Die Achsen werden von Hand in die gewünschten Sollpositionen 
gefahren, und danach erfolgt deren Übernahme ins Programm. 
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Außerdem soll die Generierung von M- und G-ßefehlen erwähnt werden, die bei ein¬ 
facher Programmierung eine hohe Flexibilität der IRS 600 gewährleistet. 

Mittels G-ßefehlen können Zeitglieder, Koinzidenzbereiche, Koordinatentransforma¬ 
tionen und Korrekturwerte programmiert werden. Durch Generierung der den M-ßefeh- 
len zugeordneten Variablen (insgesamt stehen 84 solcher Variablen zur Verfügung) kön¬ 
nen Verriegelungsbedingungen in das Routineprogramm eingefügt, Eingänge abgefragt, 
Ausgänge gesetzt oder rückgesetzt werden. Während die genannten Generierungen über 
das Teach-in-Tableau erfolgen, können mittels Serviceeinheit für Achsdaten, die vom 
Hersteller der Steuerung festgelegt werden, neue Werte generiert werden. Das betrifft 
Maximalgeschwindigkeit, Einrichtegeschwindigkeit, Koinzidenzbereiche, Einfahrkurve, 
Verfahrbereich, Nockenpositionen. Damit wird die Möglichkeit gegeben, die Steuerung 
optimal an die jeweiligen Anwenderforderungen anzupassen. 


8.3.3. Industrierobotersteuerung IRS 650 

Die IRS 650 ist eine Industrierobotersteuerung, die als freiprogrammierbare ßahnsteue- 
rung für prozeßflexible Industrieroboter für technologische Operationen und als Weiter¬ 
entwicklung auch für ßeschickungsaufgaben (als IRS 651) geeignet ist. Sie ist für In¬ 
dustrieroboter mit bis zu sechs vorwiegend elektrisch angetriebenen NC-Achsen ausgelegt, 
deren zeitlich miteinander koordinierte ßewegungen zur Erzeugung räumlicher Kurven 
gesteuert werden. 

Als erste Einsatzfälle wurde die IRS 650 an die Gelenkroboter IR 10 und 60 des VEß 
Kombinat „Fortschritt“ Landmaschinenbau angepaßt, auch in Verbindung mit Schweiß¬ 
einrichtungen des Zentralinstituts für Schweißtechnik Halle. Die Achsen sind lage¬ 
geregelt mit unterlagertem Drehzahl- und Stromregelkreis. Zum Einsatz gelangen die 
drehzahlgeregelten Thyristorantriebe AA 100 mit Ipulsiger Schaltung. Sie wurden spe¬ 
ziell für das Roboterprogramm der DDR entwickelt; die Gleichstrommotoren RSM 10 
(1,3 Nm) und RSM 60 (3,5 Nm) sind dabei in Kurzbauweise roboterfreundlich ausgelegt. 
Für ausreichende Dynamik ist immer eine genügend große Drehmomentreserve vor¬ 
zusehen. Die sechs Achsen sind in zwei Gruppen einzuteilen. Drei Hauptachsen für die 
Orientierung des Greifers im Raum, drei Nebenachsen für die zusätzliche Feinorientie¬ 
rung des Greifer-Werkzeug-Systems. 

Für die Lageerfassung dienen inkrementale Geber IGR 400 mit Nullimpuls (VEß 
Carl Zeiss, JENA), die 400 Impulse/Umdrehung erzeugen, was eine Auflösung kleiner 
als 1° an der Motorwelle bedeutet. Sie werden direkt an die Antriebsmotoren ange¬ 
flanscht. Die Signalübertragung ist mittels Kabels auf 15 m Entfernung möglich. Die 
Lageregelkreise sind digital mittels Mikrorechners ausgeführt und geben die Sollwerte im 
ßereich +10 V an den unterlagerten Drehzahlregelkreis aus. Zur Umwandlung der digi¬ 
talen Werte in analoge Spannungen dienen 14-bit-D/A-Wandler. 

Erreichbare Hauptparameter der ßewegungsvorgänge sind 

- programmierbarer Vorschub 18 bis 20- 10^ 7s an der Motorwelle mit einer Hand¬ 
beeinflussung von 5 bis 100% (Override); 

- maximale Geschwindigkeit 2 m/s bei einer umgerechneten Auflösung von 0,1 mm, 
Motordrehzahl 3000 U/min; 

- optimale ßeschleunigung einstellbar; 

- Schrittmaß \ K, 10 AT oder 100 K mal Wegauflösung 
{K generierbare Konstante); 

- maximale Weglänge 8-10® mal Wegauflösung; 


18 Industrierobotersteuerung 
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- Referenzpunkt, Softwareendschalter, Sicherheitsendschalter als öffnender Schalter, 
Näherungsinitiatoren. 

Programmiert wird die Geschwindigkeit der Leitachse, d.h. der Achse mit dem größten 
Weg zwischen zwei Punkten Pj und P 2 . Die Steuerung beaufschlagt die anderen Achsen 
so, daß P 2 von allen Achsen gleichzeitig erreicht wird. 

Die IRS 650 kann extern textuell programmiert werden, wobei die Programmeingabe 
mittels Magnetbands (KMBG K5200) erfolgt. Vorzugsweise wird das Bearbeitungspro¬ 
gramm aber im indirekten Teach-in-Verfahren vor Ort erstellt. Die Achsen werden dabei 
von Hand verfahren, und nach Erreichen der gewünschten Positionswerte werden diese 
in den Programmspeicher übernommen, während die Daten des übrigen Satzaufbaus 
(nach TGL 200-0863), wie Programm- und Satznummer, Weg- und Hilfsbedingungen, 
Unterprogramme, Geschwindigkeiten sowie Variable, über Tastatur eingegeben werden 
können. Wie bei NC-Programmen sind Programm Verzweigungen, -schleifen und -Sprünge, 
Zähl- und Zeitstufen möglich; spezifisch für Roboter sind Stapelalgorithmen installiert. 

Für den Anschluß an einen übergeordneten Rechner (DNC) zur Produktionssteuerung 
und -datenerfassung sowie von Peripherie sind standardisierte Interfaces V 24 (RS 232) 
bzw. IFSS als bidirektionale Datenkanäle vorgesehen. 

Inbetriebnahme und Service werden durch Einsatz des Bildschirmgeräts K8911 (VFB 
Kombinat Robotron) mit komfortablem Dialog unterstützt. 

Zur Verbindung mit dem Prozeß stehen 48 digitale Eingänge einschließlich Sensor¬ 
eingänge, mit 10 bis 20 mA belastbar, und 48 digitale Ausgänge, mit 100 mA belastbar, 
zur Verfügung, die neben Notfunktionen, Endschalterinformationen, Start, Stop usw. 
ausreichend wahlfreie Belegungen gestatten. Als einheitlicher Signalpegel am Steuerungs¬ 
system wurden 24 V GS gewählt. Höhere Stromstärken und Wechselspannung bedingen 
das Zwischenschalten eines Relais, z.B. GBR 20.1. 

Die gewünschte Betriebsart ist am Schrank einstellbar, wobei ihre Veränderung mit der 
Umschalthandlung wirksam wird, wenn diese zulässig ist. 

Vorgesehen sind: 

Handbetrieb, Einrichten 

Achsen bewegbar, Referenzpunkt nicht notwendig anzufahren, reduzierte Geschwindig¬ 
keit (wird angezeigt). 

Referenzpunkt 

Einzeln je Achse von Hand oder selbständige Aufnahme des Referenzpunktes, Ausfüh¬ 
rung wird angezeigt. 

Programmieren 

Teach-in-Tableau aktiv, Übernahme in den Programmspeicher. 

Automatik 

nur nach Referenzpunktaufnahme wirksam. 

Alle vorhandenen Programme startbar; nach Stop Übergang in ein anderes Programm 
möglich. 

Programmeinj-ausgabe 

Übernahme des Bearbeitungsprogramms vom Halbleiterspeicher auf die Magnetband¬ 
kassette und umgekehrt. 
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8.3.3.1. Gerätetechnik 

Die IRS 650 ist in einem Schrank 600 mm x 600 mm x 1800 mm unlergebracht, der die 
Logik, die PC, die Leistungsglieder und die Einphasen-Thyristorstromrichter TDR 100 
einschließlich Drosseln aufnimmt. Der Schutzgrad IP 54 wird durch Zweikreiskühlung 
(Wärmetauscher) erreicht. Das Magnetbandkassettengerät (Schutzgrad IP 43) und das 
Teach-in-Tableau (Schutzgrad IP 54) sind extern angeordnet. Die Hardwarestruktur der 
IRS 650 ist im Bild 8.10 dargestellt. 



Bild 8.10. Blockschaltbild der IRS 650 


Die Steueralgorithmen werden in Mikrorechnern verarbeitet, wobei deren Basis der 
Mikroprozessor U880 ist. Die Logikkassette koppelt mittels gedruckter Rückverdrahtung 
über den K1520-Systembus (TGL 37271/01) die beiden Recheneinheiten (ZRE 2521 des 
Kl520 und die speichergekoppelte Recheneinheit) mit den Speichern, den Anschluß¬ 
steuerungen und den Ein-/Ausgabe-Modulen. Fest installiert für das Betriebssystem sind 
32 KByte EPROM und 8 KByte CMOS-RAM. 

Vorgesehen sind maximal 20 KByte für interne Anwenderprogramme, wahlweise 
16 KByte gestützterCMOS-RAM<]der 4 KByte gestützte CMOS-RAM und 16 KByte 
DRAM (bzw. EPROM). Damit sind bis zu 800 Raumpunkte speicherbar. Eine EPROM- 
Programmiereinheit (K0420) für die Datenübernahme RAM-EPROM bzw. KMB- 
EPROM (mit Bildschirmgerät K8911) ist anschließbar. 

In den Anschlußsteuerungen werden die peripheren Signale in die busadäquate Form 
gewandelt. Das KMB-Gerät wird interruptgesteuert angeschlossen. Anzeigefunktionen 
erfüllen eine 4stellige 7-Segment-Anzeige und 16 LED auf dem Teach-in-Tableau. Zur 
Überwachung der Stromversorgung und der Temperatur sind Vorkehrungen getroffen, 
und eine spezielle KBG UEW dient der Überwachung rechnerinterner Funktionen. 

Bei Fehlern werden neben der Sicherheitsschaltung Datenrettungsroutinen gestartet. 

Die Signale der Prozeß-Ein-/Ausgabe werden angezeigt, um die Signalverläufe verfol¬ 
gen zu können. 

Die Ausgabe von Informationen an den Prozeß wird erst nach fehlerfreier Grund¬ 
diagnose und damit Betriebsbereitschaft freigegeben. 
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Die Mikrorechentechnik erlaubt die Eigendiagnose der gesamten Hardware. Das ent¬ 
sprechende Programm wird über Magnetband geladen; die Aussage erfolgt auf dem an¬ 
schließbaren Bildschirmterminal K8911. 

Die Steuer- und regeltechnische Anpassung der im Betriebssystem enthaltenen Funk¬ 
tionen geschieht durch Generierung im Inbetriebnahmeprozeß. 

Zur Anzeige gelangen wahlweise 

- Satznummer; 

- Haupt-, Unterprogrammnummer; 

- Fehler (nach blinkender Statusanzeigetaste erfolgt die Anzeige durch Tasterbetäti¬ 
gung). 

Die Zehnertastatur hat Doppelfunktionen, wobei automatisch umgeschaltet wird ent¬ 
sprechend der Syntax des Satzaufbaus. 

8.3.3.2. Programmsysteme 

In der IRS 650 sind zwei Arten von Programmen zu unterscheiden: 

- residente Programme im EPROM der Steuerung, die jederzeit aufgerufen werden kön¬ 
nen; 

- nachladbare Programme auf Magnetbandkassette, die nur zeitweilig benötigt und da¬ 
her von Hand in die internen (RAM-)Speicher geladen werden. 

Das zentrale residente Programm ist das Satzbetriebssystem SABE. Es ermöglicht: 

- die Ein-/Ausgabe von Informationen in Verbindung mit der Befehlstafel; 

- das Editieren des Bearbeitungsprogramms in der Programmier- bzw. Optimierungs¬ 
phase; 

- eine Bewegung der Roboterachsen durch Handbefehle, indem zeitweilig Wegsätze ge¬ 
bildet werden, die von der Wegsteuerung weiterverarbeitet, jedoch nicht dauerhaft ab¬ 
gespeichert werden; 

- den Einzelsatzbetrieb des Bearbeitungsprogramms; 

- die Übersetzung des Bearbeitungsprogramms (Anwenderprogramm) vom Quellkode 
nach TGL 200-0863 in den internen Objektkode 

Das NC-Programmformat wurde wegen seiner allgemeinen Verbreitung zum Standard¬ 
eingabeformat gewählt; es bedingt jedoch relativ viel Speicherplatz, und seine Verarbei¬ 
tung ist zeitaufwendig. 

Deshalb wird der Quellkode sofort umgesetzt in 

- Wegsätze von 24 Byte, die alle Informationen für die Bewegung P„ Pn+i enthalten 
und die von der Wegsteuerung weiterverarbeitet werden; 

- PC-Sätze von 12 Byte, die in der PC oder von SABE selbst abgearbeitet werden. 

Auch die Information auf dem Magnetband im Format nach ISO 3407 wird in den 
Objektkode während des Einlesens gewandelt, umgekehrt beim Archivieren. 

Das Satzbetriebssystem übersetzt die im Bearbeitungsprogramm absolut stehenden 
geometrischen Daten in relative Maße. Das residente Programm Wegesteuerung (WST) 
errechnet die Sollwerte für die Lageregelkreise, indem die je Achse generierbaren Be- 
schleunigungs- und Bremsvorgänge geführt sowie die Bewegung der bis zu sechs Achsen 
koordiniert werden. Durch WST wird vom Satzbetriebssystem die Folgeinformation 
abgerufen und zwischengepuffert. 

Das residente Programm programmierbare Steuerung PC steuert die technologischen 
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Prozesse durch Interpretation Boolescher Gleichungen und Abfrage bzw. Beaufschlagung 
der Ein-/Ausgabe-Kanäle. 

Der Lageregelungsalgorithmus wird vom Programm Lageregelung LAR abgearbeitet, 
wozu der zweite Mikrorechner der IRS 650 dient. Die Tastzeit für sechs Achsen beträgt 
10 ms. Dieses Programm sorgt für die Referenzpunkterfassung, es überwacht die zulässi¬ 
gen Achsbewegungen und gestattet die Anpassung der Konstanten der Regelalgorithmen 
an die dynamischen Eigenschaften der Achsen durch Generierung. 

Die Programme für Ein- und Ausgabe an die Befehlstafel, die Bildschirmeinheit und das 
Kassettenmagnetbandgerät können von den anderen Programmen genutzt werden. 

Die nachladbaren Programme (offline) Monitor und Editor MON/EDIT bedingen das 
Vorhandensein der Bildschirmeinheit K8911. Sie erwirken die Anzeige und die Behand¬ 
lung des Programms sowie von Einzeldaten und gestatten Veränderungen im Bearbei¬ 
tungsprogramm. Diese Dienstprogramme steigern den Korrekturkomfort. Die Einschalt¬ 
programme (On-line-Diagnose) stellen den Initialzustand her und realisieren die Ein¬ 
schaltdiagnose. Sie geben die Bearbeitung durch Betriebsbereitschaftsmeldung frei bzw. 
melden Fehler. 

Die beiden nachladbaren Programme Generierung GEN und Offline-Diagnostik DIAG 
dienen der Inbetriebnahme des Industrieroboters durch Unterstützung bei der Eingabe 
von Generierdaten (z. B. Verstärkung, Drehsinn, Beschleunigung, Geschwindigkeit beim 
Einrichten, Softwareendschalter) und dem Service, d.h. der Fehlersuche bis zur Steck¬ 
einheit sowie dem zyklischen Test. Es lassen sich auch die residenten Programme kon¬ 
trollieren. Die Steuerung gestattet zwei Arbeitsweisen: 

- Echtzeitbetrieb (Antriebe aktiv) 

- Testbetrieb (Antriebe inaktiv). 

Zur Sicherung der Zeitbilanz werden einige Programmkomplexe als Hintergrundpro¬ 
gramme betrieben, die von den Echtzeitprogrammen mittels Interrupts, wenn nötig, 
unterbrochen werden. 

8.3.3.3. Programmierung 

Die geometrischen Daten werden im indirekten Teach-in programmiert, indem durch 
Handbetätigung der Achsantriebe die Position angefahren und durch Tastendruck das 
Speichern ausgelöst wird. Die Befehle im Wort werden durch Tasten eingegeben. Die Pro¬ 
grammiervorschrift entspricht dem NC-Programm, TGL 200-0863 mit einem möglichen 
Befehlsvorrat: 

N xxx; F xxxx; G xx; H xxxx; L xx; M xx; % xx; 

Ausgänge HXO xx; Eingänge HXl xx; Zeitstufe H02 xx; Zähler H03 xx. 

Die Geschwindigkeit F wird als Vielfaches der Winkelauflösung angegeben, 21 Zusatz¬ 
funktionen M sind definiert. Die Wegbedingungen G bezeichnen Punktsteuerung, Bahn¬ 
steuerung, Sensor- und Referenzfunktion, Fein- und Grobpunkt. 

Wie allgemein üblich, ist eine Bedienerführung installiert, wobei LED die Adresse an¬ 
geben und die Ziffern angezeigt werden. Bei Wortende blinken die zulässigen Adreßtasten 
für das Folgewort, bei Satzende blinkt die Taste Satzabschluß. Während Blinken zur Ein¬ 
gabe animiert, wird durch dauerndes Leuchten die Betätigung quittiert. 

Extern kann mittels Bürorechners A5130 mit dem Programmpaket E IRS 650 ein Pro¬ 
gramm textuell auf eine Magnetbandkassette geschrieben werden, das vor Ort an der 
IRS 650 korrigiert werden kann. 

Eine große Erleichterung tritt ein, wenn off-line alle PC-Sätze programmiert werden 
und vor Ort nur die Geometriesätze eingefügt werden. 
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8.4. Industrierobotersteuerung ursalog 5021 

Die Industrierobotersteuerung ursalog 5021 des VEB EAW Berlin wurde in Zusammen¬ 
arbeit des Instituts für Regelungstechnik Berlin und der Ingenieurhochschule Mittweida 
entwickelt und ist für die Steuerung von im direkten Teach-in programmierbaren und 
hydraulisch angetriebenen technologischen Industrierobotern vorgesehen. Als kinema¬ 
tische Grundeinheiten sind vor allem die für die Operationen Beschichten/Farbspritzen, 
Strahlen, Wischen und Putzen entwickelten Gelenkarmsysteme TR 79 und TR 10 des 
VEB „Sachsenring“ Automobilwerke Zwickau vorgesehen. Entsprechend den genannten 
Einsatzgebieten leiten sich folgende die Struktur und den Aufbau der Steuerung wesent¬ 
lich prägende Forderungen ab: 

- Speicherung des Ort-Zeit-Verlaufs der zu programmierenden Bahnkurve im echten 
Zeitbezug und die Möglichkeit der Einflußnahme im Sinne einer Zeitraffung und Zeit¬ 
dehnung bei der Wiedergabe (z.B. für die Synchronisation mit Fördersystemen); 

- Einfügen bzw. Löschen von programmorganisatorischen und das Aktionsverhalten 
bestimmenden Befehlen nach erfolgter Programmierung der Bahnkurve; 

- Einsatz von Positionsmeßsystemen und Antriebsstellelementen einschließlich deren 
Signalverarbeitungseinheiten, die den Forderungen nach Explosionsschutz entspre¬ 
chend TGL 30020 gerecht werden. 

Im Gegensatz zu verschiedenen Industrierobotersteuerungen für das direkte Teach-in- 
Programmierverfahren [8.23] [8.24], bei denen Massenspeicher mit seriellem Zugriff 
(z. B. Folienspeicher) als Arbeitsspeicher für die Aufzeichnung und für die Wiedergabe 
des Roboterprogramms Anwendung finden, werden bei der Steuereinrichtung ursa¬ 
log 5021 Halbleiterspeicher dafür verwendet. Lediglich zur Archivierung von Roboter¬ 
programmen findet ein Kassettenmagnetbandgerät Anwendung. Damit wird sowohl dem 
Trend nach Einsatz von Halbleiterspeichern mit immer größerem Speichervermögen als 
auch der Forderung nach Erhöhung der Zuverlässigkeit Rechnung getragen. 

Die Industrierobotersteuerung ursalog 5021 ist unter Verwendung von Baugruppen 
des Mikrorechnersystems Kl 520 des Systems 600 und des industriellen Steuerungssystems 
ursalog 5020/ursadat 5000 konfiguriert; der funktionelle Inhalt wird weitgehend durch 
Software realisiert. Eine Beschreibung des Systems 5020 und insbesondere der in der 
Industrierobotersteuerung ursalog 5021 verwendeten Baugruppen befindet sich im An¬ 
hang 2. 

8.4.1. Allgemeine Charakteristik 

Die Industrierobotersteuerung ursalog 5021 ist als Multipunktsteuerung mit Interpolator 
konzipiert. Großer Wert wird auf einen möglichst breiten, nicht nur auf eine einzige tech¬ 
nologische Operation zugeschnittenen Funktionsinhalt gelegt. Durch die beim Hersteller 
durchzuführende Grundinitialisierung ist die Steuereinrichtung in Verbindung mit ge¬ 
eigneten kinematischen Grundeinheiten für. alle die technologischen Grundoperationen 
geeignet, bei denen der Bewegungsablauf bei der Programmierung zweckmäßig im direk¬ 
ten Zeitbezug vorgegeben wird. Die wesentlichsten Hauptparameter der Steuereinrich¬ 
tung sind: 

- statische Positioniergenauigkeit: +0,2 mm bzw. +0,2° bezogen auf Antriebselemente 
mit einem Hub von 220 mm bzw. einer Drehung von 210° (die auf das Werkzeug be¬ 
zogene Positioniergenauigkeit ist von der Bauform der kinematischen Gelenkeinheit 
und deren momentane Position im Raum abhängig); 
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Anzahl der lageregelbaren Achsen: maximal 8, abrüstbar auf 6, 4, 2 Achsen; 
Auflösung des Stellwegs bei potentiometrischen Meßsystemen: 12 Bit; 
Programmdauer: Die maximale Programmdauer ist von der Anzahl der betriebenen 
Achsen, dem vorgewählten Faktor für den Taktteiler und der Ausrüstungsvariante 
bezüglich des Arbeitsspeichers abhängig. Für die vollständige Speicherausrüstung mit 
256 KByte sind in der Tafel 8.2 die möglichen Programmlaufzeiten angegeben; 


Tafel 8.2. Mögliche Programmdauer in Abhängigkeit der Achsanzahl 
und des Taktteilers bei einer Speicherausrüstung von 256 KByte 


Achsen 

Taktteiler 

1 2 

4 

8 

16 

2 



1280 s 


5120 s 

4 



840 s 



6 



640 s 

1280 s 

2560 s 

8 



520 s 

1040 s 

2080 s 


Interpolator: Glättungsinterpolator 3. Grades mit extern einstellbarem Taktteiler; 
Anzahl der aufrufbaren Programme: 128; 

Ausgabe des Stellsignals: 

für elektrische Antriebe ±10 V, für hydraulische Antriebe ±50 mA (Lastwiderstand 
50 Ü); 

Anzahl der binären Ein- und Ausgänge: 


32 Eingänge über Optokoppler 4 8,6 bis 12,2 mA 

C/e 12 V ± 10% 

/g 0,5 mA 
C/e 1,4 V 


bei 1-Signal 


bei 0-Signal 


24 Ausgänge potentialgetrennt I/Amax 


60 V 
0,5 A 
10 W 


Gs/Ws 


Eine beliebige Anzahl von Eingängen und Ausgängen können für einen bestimmten 
Anwendungsfall durch eine Anwenderinitialisierung maskiert werden und stehen da¬ 
nach nicht im Sinne einer freien Programmierbarkeit unter Verwendung des Befehls¬ 
satzes zur Verfügung; 

Befehlssatz der Steuereinrichtung: 21 Befehle (Synchronisations-, Verzweigungs-, Ver- 
zögerungs- und Prozeß-Ein-/Ausgabe-Befehle); 

interner/externer Takt: wahlweise Synchronisation auf internen oder externen Takt. 
Durch Bereitstellung eines externen Taktes kann die Bewegung des Roboters an peri¬ 
phere Einrichtungen angepaßt werden (z.B. Förderbandsynchronisation). Bei externer 
Taktvorgabe ist eine Zeitraffung bzw. Zeitdehnung um ±10% gegenüber der Auf¬ 
nahme möglich; 

sekundärer Massenspeicher für Programmarchivierung: 

Kassettenmagnetbandgerät K5200; 

Bedienung und Anzeige: Die Bedienung und Anzeige erfolgt über eine alphanumerische 
Tastatur und eine alphanumerische Anzeige. Zur Vermeidung von Bedienfehlern ist 
die weitestgehende Führung des Bedieners realisiert (Menütechnik). Die Tastatur mit 
Anzeige befindet sich im Steuerschrank; sie kann bei Programmierungsarbeiten vom 
Schrank abgesetzt betrieben werden. 
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- Diagnosefunktionen: Zur Vermeidung von Havarien laufen nach dem Einschalten und 
während des Betriebs der Steuereinrichtung komplexe Diagnoseprogramme ab. Zur 
Überprüfung der Funktionsfähigkeit des Gesamtsystems sind eine Reihe von durch 
den Bediener aufrufbaren Serviceprogrammen implementiert. Zu Testzwecken kann 
durch Bahnvorgabe über das Kassettenmagnetbandgerät das definierte Verfahren des 
Roboters erzielt werden. 

- Explosionsschutz: Auf Wunsch wird die Steuereinrichtung für das Betreiben des kine¬ 
matischen Systems in explosionsgefährdeten Räumen (Gasexplosionsgefährdungs¬ 
gruppe EG 3, Zündgruppe T2, Zündwilligkeitsgruppe IIB) für potentiometrische 
Positionsmeßsysteme (Eigensicherheit) geliefert. Für die Stellsignalausgabe (hydrau¬ 
lische Antriebe) ist die Schutzart „Sonderschutz“ durch das Servoventil zu realisieren. 
Die binären Eingangs- und Ausgangssignale sind nicht explosionsgeschützt; für den 
Ex-Schutz sind entsprechende pneumatisch-elektrische Signalwandler vorzusehen 
(z.B. PE-Wandlerblock PE IB). 

- Gefäßsystem: EGS-Schrank mit Sichtfenster 800 mm x 1600 mm x 600 mm, Schutz¬ 
grad IP 54. 


8.4.2. Bedienung und Programmierung 

Die Robotersteuerung ursalog 5021 ist eine freiprogrammierbare Steuereinrichtung für 
Bewegungs- und Aktionsabläufe mit eigenem Befehlssatz. Für die Bedienung und Pro¬ 
grammierung steht eine alphanumerische Tastatur als Eingabegerät und eine 32stellige 
5 X 7-Punktmatrix-Anzeige für die Darstellung von Texten zur Verfügung. Bis auf wenige, 
direkt in das Starkstromteil eingreifende Bedienelemente (z.B. Not-Aus) erfolgen alle 
Bedienhandlungen über diese Tastatur. Konstruktiv bildet die Tastatur mit der Anzeige 
eine Einheit. Zur Gewährleistung des Schutzgrads IP 54 ist diese innerhalb des Steuer¬ 
schranks angeordnet und durch Öffnen einer mit einem Fenster versehenen Tür zugäng¬ 
lich. In der Regel wird die Bedienung/Programmierung von da aus erfolgen; es besteht 
jedoch die Möglichkeit, die Tastatur mit der Anzeige aus ihrer Halterung zu entfernen 
und sie vom Steuerschrank abgesetzt zu betreiben. 

Das Bedienkonzept der Steuereinrichtung baut auf drei Ebenen auf; sie unterscheiden 
sich durch die an den Bedienenden zu stellenden Anforderungen: 

- Bedienung im Sinne der Herstellung der Wiedergabebereitschaft bei vorhandenen 
Roboterprogrammen auf Magnetbandkassette; 

- Programmierung von neuen Bewegungs- und Aktionsfolgen und deren Archivierung 
auf Magnetbandkassette; 

- Durchführung von Testoperationen zur komplexen Überprüfung/Diagnose des Ge¬ 
samtsystems, bestehend aus dem kinematischen Grundgerät, den peripheren Einrich¬ 
tungen und der Steuerung. 

Während die erste Stufe der Bedienung durch einen mit den wesentlichsten Bedien¬ 
handlungen vertrauten Operator vorgesehen ist, erfordert die zweite Stufe Kenntnisse 
über den Befehlssatz der Steuerung und das Verhalten peripherer Komponenten (z.B. 
Teileerkennungssystem). Die höchste Stufe ist für versierte Servicetechniker Vorbehalten 
und erlaubt die komplexe Bedienung im Rahmen von Erstinbetriebnahmen oder bei 
Fehlersuche. 

Im Bild 8.11 wird die der Bedienerführung zugrunde gelegte Baumstruktur gezeigt. 
Nach dem Einschalten der Steuereinrichtung wird dem Bedienenden mit der Anzeige 
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Bild 8.11. Baumstruktur der Bedienerführung 


„Betriebsart“ signalisiert, daß er eine der möglichen Betriebsarten „Aufnahme“, „Wie¬ 
dergabe“, „Kassettenmagnetbandgerät lesen“, „Kassettenmagnetbandgerät schreiben“, 
„Anwenderinitialisierung“ oder „Diagnose“ auswählen muß. Mit der Betätigung einer 
Quittungstaste wird ihm die Betriebsart „Aufnahme“ angeboten. Soll eine Programm¬ 
aufnahme oder -modifizierung erfolgen, so wird in diesem Ast der Baumstruktur ver¬ 
blieben und dem Operator die „Programmierung“ durch Anzeige angeboten. Wünscht er 
ein Programm zu löschen, gelangt er durch zweimaliges Betätigen der Organisationstaste 
PH zur Eingabemöglichkeit eines „Kommandos“. Nach erfolgter Quittierung wird dem 
Bedienenden zuerst die Möglichkeit der Suche nach einem im Speicher befindlichen Pro¬ 
gramme angeboten. Da er jedoch ein Programm löschen möchte, betätigt er erneut die 
Organisationstaste Q und bekommt mit „Programm löschen“ die gewünschte Betriebsart 
angeboten. Sobald die Quittung erfolgt, wird er durch Anzeige aufgefordert, die Nummer 
des zu löschenden Programms einzugeben. Nach Betätigung der Quittungstaste wird das 
Programm gelöscht und erneut „Programm löschen“ angeboten. War nur ein Programm 
zu tilgen und soll im weiteren die Betriebsart „Wiedergabe“ aufgerufen werden, so wird 
durch zweimaliges Betätigen der Organisationstaste [T] der Ast bis zur Betriebsart „Auf¬ 
nahme“ in umgekehrter Richtung durchschritten. Danach hat der Bediener die Organisa¬ 
tionstaste p] zu betätigen und ruft damit die gewünschte Betriebsart auf. Wird in der 
Folge die Taste \T\ gedrückt und erfolgt die Quittierung, gelangt die Steuerung in den Zu¬ 
stand der Wiedergabebereitschaft („Hydraulikwegeventil ein“). 

Alle Betriebsarten lassen sich in der für das Löschen eines Programms und der Her¬ 
stellung der Wiedergabebereitschaft beschriebenen Art und Weise aufrufen. 
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Die automatisch ablaufende und zu einer bestimmten Betriebsart (z.B. Wiedergabe¬ 
bereitschaft) führenden Bedienung ist möglich, wenn dies im Rahmen der Anwender¬ 
initialisierung vorgenommen und als „Präambel“ auf Kassettenmagnetband gespeichert 
wurde. Dies ist in allen den Fällein vorteilhaft anwendbar, bei denen nach Einschaltendes 
Roboters eine Programmwiedergabe mit einer bestimmten Programmnummer erfolgt. 


Befehlssatz der Steuereinrichtung ursalog 5021 


In der Betriebsart „Aufnahme“ werden Informationen über die Bewegung/Geometrie und 
über das Ablaufverhalten/Aktionsverhalten in den Anwenderspeicher der Steuerung ein¬ 
geschrieben. In diesem Speicher können bis zu 128 unterschiedliche Programme variabler 
Länge abgelegt werden. Die Gesamtdauer der Programme wird durch die zur Verfügung 
stehende Speicherkapazität und den gewählten Taktteiler für den Interpolator bestimmt 
und kann aus Tafel 8.7 entnommen werden. Jedes Programm besteht aus einer endlichen 
Anzahl von Anweisungen, deren prinzipieller Aufbau im Bild 8.12 angegeben ist. Der 


Anweisung 



Bild 8.12 

Prinzipieller Aufbau einer Anweisung 

Sl bis S8 Positionsstützwerte: Befehl; 
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Bild 8.13 

Beispiel einer Zuordnung von binären 
Ein- und Ausgängen zu den Operanden 
der Verzweigungsbefehle 


Anweisungszähler, ein Zeiger, der die aktuelle Anweisung adressiert, sorgt für das Ein¬ 
schreiben (Auslesen bei der Wiedergabe) in einer steigenden Folge von virtuellen Adres¬ 
sen. Eine Einzelanweisung setzt sich aus der Geometrieanweisung und der (möglichen) 
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Tafel 8.3. Befehlssatz der Steuereinrichtung ursalog 5021 


Befehlsgruppe 

Mnemonik 

Operations-Operandkode 

Wirkung des Befehls 

Synchronisation des 
Anweisungszählers 

HU 

Halt unbedingt 

Der Anweisungszähler wird angehalten. Ein er¬ 
neuter Programmstart ist nur durch eine Bediener¬ 
handlung möglich. 


HB LTE 

Halt bedingt 

Der Anweisungszähler wird bedingt angehalten. 
Die Bedingung ist für die ausgewählten Leitungen 
im Operanden anzugeben. Ein erneuter Programm¬ 
start ist nur durch eine Bedienerhandlung möglich. 


LB LTE 

Lauf bedingt 

Der Anweisungszähler wird bedingt gestartet. Die 
Bedingung ist für die ausgewählten Leitungen im 
Operanden anzugeben. 


WB LTE 

Warten bedingt 

Der Anweisungszähler wird so lange angehalten, 
bis die im Operanden anzugebende Leistungs¬ 
bedingung erfüllt ist. 

Veränderung des 

Anweisungszählers 

(Verzweigungen) 

SUD PNR 

Sprung unbedingt direkt 

Der Anweisungszähler wird auf die im Operanden 
anzugebende Programmnummer gestellt. 


SBD LTE, PNR 

Sprung bedingt direkt 

Der Anweisungszähler wird auf die im 2. Operan¬ 
den anzugebende Programmnummer gestellt, wenn 
die im 1. Operanden anzugebende Leitungsbedin¬ 
gung erfüllt ist. 


SUI 

Sprung unbedingt indirekt 

Der Anweisungszähler wird auf die Programm¬ 
nummer gestellt, die an ausgewählten Leitungen 
vorzugeben ist. Die Festlegung der dafür vorge¬ 
sehenen Eingangsleitungen muß im Rahmen der 
Grundinitialisierung der Steuerung erfolgen. 


SBI LTE 

Sprung bedingt indirekt 

Der Anweisungszähler wird auf die Programm¬ 
nummer gestellt, die an ausgewählten Leitungen 
(siehe SUI) vorzugeben ist, wenn die im Operan¬ 
den anzugebende Leitungsbedingung erfüllt ist. 


RUD PNR 

Ruf unbedingt direkt 

Der Anweisungszähler wird auf die im Operanden 
anzugebende Unterprogrammnummer gestellt. Der 
Anweisungszählerstand 4-1 wird im Stapelspeicher 
abgelegt. 


RBD LTE, PNR 

Ruf bedingt direkt 

Der Anweisungszähler wird auf die im 2.0peran- 
! den anzugebende Unterprogrammnummer gestellt, 
wenn die im 1. Operanden anzugebende Leitungs¬ 
bedingung erfüllt ist. Der Anweisungszählerstand 
-1-1 wird im Stapelspeicher abgelegt. 


RUI 

Ruf unbedingt indirekt 

Der Anweisungszähler wird auf die Unter¬ 
programmnummer gestellt, die an ausgewählten 
Leitungen vorzugeben ist. Die Festlegung der da¬ 
für vorgesehenen Eingangsleitungen muß im Rah¬ 
men der Grundinitialisierung der Steuerung er¬ 
folgen. Der Anweisungszählerstand -bl wird im 
Stapelspeicher abgelegt. 
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Tafel 8.3 (Fortsetzung) 


Befehlsgruppe 

Mnemonik 

Operations-Operandkode 

Wirkung des Befehls 


RBI LTE 

Ruf bedingt indirekt 

Der Anweisungszähler wird auf die Unterpro¬ 
grammnummer gestellt, die an ausgewählten Lei¬ 
tungen (siehe RUI) vorzugeben ist, wenn die im 
Operanden anzugebende Leitungsbedingung er¬ 
füllt ist. Der Anweisungszählerstand +1 wird im 
Stapelspeicher abgelegt. 


RU 

Rückkehr unbedingt 

Der Anweisungszähler wird auf den zuletzt im 
Stapelspeicher abgelegten Anweisungszählerstand 
gestellt. 


RB LTE 

Rückkehr bedingt 

Der Anweisungszähler wird auf den zuletzt im 
Stapelspeicher abgelegten Anweisungszählerstand 
gestellt, wenn die im Operanden anzugebende Lei¬ 
tungsbedingung erfüllt ist. 

Verzögerung des 
Anweisungszählers 

VZ ZEIT 

Verzögerung, Zeit 

Der Anweisungszähler wird für die im Operanden 
anzugebende Zeit angehalten. Nach Ablauf der 
Zeit wird der Anweisungszähler gestartet. 


VT TAKT 

Verzögerung, Takt 

Der Anweisungszähler wird für die im Operanden 
anzugebende Anzahl von externen Takten ange¬ 
halten. Danach wird der Anweisungszähler ge¬ 
startet. 

Prozeß- 

Ein-/Ausgabe 

AU LTA 

Ausgabe unbedingt 

Die für eine Ausgabe vorgesehenen Leitungen ein¬ 
schließlich deren binärer Belegung ist im Operan¬ 
den vorzugeben. Die Ausgabe bleibt bis zum näch¬ 
sten Ausgabebefehl erhalten. 


ADZ ZEIT, LTA 

Ausgabe, dynamisch Zeit 

Die Ausgabe der im 2. Operanden vorzusehenden 
binären Leitungsbelegung erfolgt für die Dauer der 
im 1. Operanden angegebenen Zeit. 


ADT TAKT, LTA 

Ausgabe, dynamisch Takt 

Die Ausgabe der im 2. Operanden vorzusehenden 
binären Leitungsbelegung erfolgt für die Dauer der 
im 1. Operanden anzugebenden Anzahl von exter¬ 
nen Takten (prozeßsynchrone Ausgabe). 


ABE LTE, LTA 

Ausgabe, bedingt Eingang 

Die Ausgabe der im 2. Operanden vorzusehenden 
binären Leitungsbelegung erfolgt, wenn die im 
1. Operanden anzugebende Leitungsbedingung er¬ 
füllt ist. 


ANW SW, i 

Anweisung; i e {1...8} 

BEF, BEF 

Dieser Befehl bewirkt die Ausführung einer Geo¬ 
metrieanweisung einschließlich möglicher Ablauf¬ 
an weisung(en). 

Die Stützwerte SW sind durch Bedienhandlungen 
einzugeben. Es können alle Ablaufanweisungen 
entsprechend dem Befehlssatz Anwendung finden. 


Ablaufanweisung zusammen. Die Geometrieanweisungen werden durch Vorführen der 
Bewegungsbahn (direktes Teach-in) erzeugt und repräsentieren je einen Stützwert für 
jede Achse des kinematischen Systems (Raumpunkt). Der zeitliche Abstand zwischen den 
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Stützwerten ist von dem gewählten Taktteiler und der internen bzw. externen Taktfre¬ 
quenz abhängig. Die Ablaufanweisungen können sowohl programmorganisatorische als 
auch das Aktionsverhalten bestimmende Befehle enthalten. Diese werden von dem Pro¬ 
grammierer in den meisten Fällen erst nach der Aufnahme der Bewegungsbahn ein¬ 
gegeben. Eine Ausnahme bilden die Ablaufanweisungen, bei denen die Belegung von 
binären Eingängen prozeßsynchron aufgezeichnet werden sollen. Die Generierung dieser 
Befehle erfolgt direkt bei der Aufnahme der Bewegungsbahn. Die Menge aller für den 
Anwender frei verfügbaren Befehle wird als Befehlssatz der Steuereinrichtung bezeichnet 
und ist in Tafel 8.3 angegeben. Die linke Spalte in der Tabelle definiert die Befehls¬ 
gruppe; die Spalte Mnemonik gibt die für die Befehlseingabe vereinbarten Operations¬ 
kodes und Operanden an. In der rechten Spalte ist die Wirkung des Befehls beschrieben. 

Die bedingten Befehle beziehen sich auf die an den binären Eingängen der Steuerein¬ 
richtung anliegenden Informationen. Im Bild 8.13 wird das allgemeine Anschlußschema 
sowohl der binären Eingangsleitungen (LTE) als auch das der binären Ausgangsleitungen 
(LTA) gezeigt. Im Rahmen der Anwenderinitialisierung der Steuerung können bestimmte 
Ein- und Ausgänge roboterspezifisch von einer Befehlsbeeinflussung ausgeschlossen wer¬ 
den. Bei der Verwendung von indirekten Verzweigungsbefehlen ist ebenfalls durch die 
Anwenderinitialisierung ein 8-Bit-Eingangsblock für die Bereitstellung der (Unter-)Pro- 
grammnummer festzulegen. 

Die Eingabe der Operanden erfolgt über die Tastatur entsprechend der Bedienerfüh¬ 
rung. Bei Anwendung des Operanden LTE ist zu beachten, daß die Notierung der Ver¬ 
knüpfung in einer disjunktiven Normalform erfolgen muß (s. auch Bild 8.44b). Soll z.B. 
die Programmabarbeitung so lange gestoppt werden, bis auf der Eingangsleitung E30 
1-Signal oder auf den Eingangsleitungen E90-Signalund auf E8 1-Signal anliegt, so ist für 
den Operanden des Befehls WB zu notieren und einzugeben: E30/E9E8. Das Operations¬ 
zeichen für die Disjunktion ist ein Leerschritt zwischen den Implikanten, während für die 
Negation ein Schrägstrich vor der betreffenden Leitungsnummer einzugeben ist. 


8.4.3. Funktionsbeschreibung 

Aufbauend auf die prinzipielle Struktur einer Industrierobotersteuerung, wie sie im Ab¬ 
schnitt 2. behandelt ist, ergeben sich folgende relativ autonome Funktionsblöcke: 

- Funktionseinheit zur Verwaltung des Speichers für das Anwenderprogramm und zur 
Befehlsinterpretation, 

- Funktionseinheit zur Kommunikation mit dem Bediener/Programmierer, 

- Funktionseinheit zur Glättungsinterpolation und Servoregelung (Lageregelung). 

Sowohl zur Realisierung einer modularen Steuerungskonzeption als auch für eine 
zweckmäßige Aufgaben Verteilung wird bei der Steuerung ursalog 5021 jedem dieser 
Funktionsblöcke ein eigener Mikrorechner zugeordnet und diese in einer Master-Slave- 
Struktur nach Bild 8.14 zusammengefaßt. Die gewählte Torkopplung nutzt die auf der 
Rechnerkarte K2521 vorhandene Zusatzlogik [8.1], zwingt aber aufgrund der begrenzten 
Übertragungsrate von etwa 30 KByte/s zu einem weitgehend autonomen Arbeiten der 
Einzelrechner. 

Die Organisation der Kopplung erfolgt durch spezielle Koppelprogramme, die sowohl 
im Master als auch in den Slaves resident sind. Dabei ist dem Master die höchste Priorität 
und dem Slave 2 die niedrigste Priorität zugeordnet. Es können unter Beachtung der 
Prioritäten Koppelanforderungen vom Master an einen der Slaves sowie von einem Slave 
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an den Master bearbeitet werden. Eine direkte Anforderung von Slave 1 an Slave 2 ist 
nicht möglich und muß über einen Masterruf abgewickelt werden. Die Koppelprogramme 
greifen im wesentlichen auf die sich in jedem Einzelrechner befindlichen und den aktuellen 
Zustand der Steuerung widerspiegelnden Abbildspeicher zu. Prinzipiell werden vier Arten 
von Kopplungen unterschieden. 

1. Datentransfer - Schreiben 

Aus dem Abbildspeicher des Senders werden Informationen in die äquivalenten Bereiche 
des Abbildspeichers des Empfängers übertragen. Der Empfänger reagiert nicht unmittel¬ 
bar auf die übertragene Information, sondern erst, wenn er zufällig darauf zugreift oder 
durch ein Kommando dazu aufgefordert wird. 

2. Datentransfer - Lesen 

Der Sender ruft Informationen aus dem Abbildspeicher des Empfängers ab und trägt sie 
in die äquivalenten Bereiche seines eigenen Abbildspeichers ein. Der Empfänger erhält 
selbst keine Kenntnis über den erfolgten Speicherzugriff. 

i. Kommando ohne Datentransfer 

Der Sender löst eine Kommandoroutine beim Empfänger aus, die unter möglicher Nut¬ 
zung von Kommandoparametern ggf. auch wieder auf den Sender zurückwirken kann. 

4. Kommando mit Datentransfer 

Der Sender löst eine Kommandoroutine beim Empfänger aus und überträgt dazu Daten. 
Auf der Empfängerseite werden die Daten im Block übernommen und ausgewertet. 



Bild 8.14 

Master-Sluve-Struktur der Industrieroboter¬ 
steuerung ursalog 5021 


Funktionsumfang Master 

Die Hardwarekomponenten des Master- oder Leitrechners sind im Bild 8.15 angegeben 
und arbeiten auf den standardisierten Systembus des Mikrorechnersystems K1520. Sie 
bestehen im einzelnen aus der Rechnerkarte ZRE K2521 mit dem Prozessor U880 und 
der kombinierten RAM/ROM-Speicherkarte OFS K3620. Auf diesen beiden Karten sind 
die Funktionalprogramme des Masters gespeichert. Für die Speicherung des Roboter¬ 
programms stehen bis zu vier TEST RAM (dynamische Speicher) mit je 64 KByte zur 
Verfügung. Die Adressierung (Auswahl) dieser Speicherkarten einschließlich ihrer Seg¬ 
mentierung erfolgt über E/A-Adressen. Über die Anschlußsteuerung AKB K5020 wird 
das für die Datenarchivierung vorgesehene Kassettenmagnetbandgerät K5200 betrieben. 
Zwei Steckeinheiten DFS 12 dienen zur Eingabe binärer Informationen über Optokopp- 
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1er (maximal 32 Kanäle). Die Steckeinheit DA-R gestattet die potentialfreie Ausgabe 
binärer Informationen (maximal 24 Kanäle), während die Anschlußsteuerung IFSS 
(/nter/ace sternförmig seriell) zur Kopplung mit einem übergeordneten Rechner dient. 


Koppelbus 



Bild 8.15. Hardwarekomponenten des Masters 


Im Masterrechner sind im wesentlichen folgende Programme implementiert: 

- Echtzeitbetriebssystem der Steuerung, 

- Programme zur Verwaltung des Wegedaten- und Befehlsspeichers, 

- Programme zur Interpretation und Ausführung der Anwenderbefehle, 

- Programme zur Archivierung des Roboterprogramms auf Kassettenmagnetbandgerät. 

Das Echtzeitbetriebssystem stellt ein neutrales, von der eigentlich zu realisierenden Auf¬ 
gabe völlig unabhängiges Programmpaket dar. Es koordiniert alle Rechenprozesse, die 
den Funktionsinhalt der Steuerung realisieren. Sowohl die im Master als auch die in den 
Slaves residenten Programme stellen für das Echtzeitbetriebssystem Tasks dar, die seiner 
Verwaltung und Koordinierung unterliegen. 

Die Programme zur Verwaltung des Wegedaten- und Befehlsspeichers ordnen den physi¬ 
kalischen Speichern (in der maximalen Ausbaustufe 256 KByte) den virtuellen Roboter¬ 
programmspeicher zu und organisieren das Beschreiben und das Auslesen von Program¬ 
men sowie das Einfügen und das Entfernen von Einzelanweisungen. In der ersten Phase 
erfolgt im Rahmen der Systeminitialisierung ein Speichertest, der evtl, fehlerhafte Spei¬ 
cher erkennt und diese in Segmenten zu 4 KByte von einer möglichen Programmaufzeich¬ 
nung ausschließt. Alle funktionsfähigen Speichersegmente werden danach zu einem Spei¬ 
cherblock gebunden, der dem Anwender sowohl zur Programmaufzeichnung als auch zur 
Übernahme von bereits erstellten Programmen aus dem Kassettenmagnetbandgerät zur 
Verfügung steht. Wie im Bild 8.16b dargestellt, wird das bei einer Programmaufnahme 
neuerstellte Programm an bereits vorhandene angefügt. Bei der Wiedergabe kann ein be¬ 
liebiger, ein vollständiges Programm repräsentierender Abschnitt ausgelesen werden. Im 
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Bild 8.16 c wird das Einfügen und das Entfernen von Einzelanweisungen bzw. Befehlen, 
das i. allg. nach jeder Programmaufnahme erfolgt, gezeigt. Die Struktur des Speichers für 
das Roboterprogramm wird im Bild 8.17 angegeben. Jedes in sich abgeschlossene Pro¬ 
gramm beginnt mit der virtuellen Adresse Null. Zu seiner Kennzeichnung wird eine 
Marke, die mit dem Programmnamen identisch ist und unter der es im Speicherraum zu 
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Programmspeicher 



Wiedergabe eines Programms 


Programmspeicher 
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Entfernen von Anweisungen 


Bild 8.16 

Organisation des Anwender¬ 
speichers 

a) Zusammenrügen des Speicherblocks 
aus Segmenten zu je 4 kbyte; b) Spei¬ 
cherorganisation bei Aufnahme und bei 
Wiedergabe eines Programms; c) Ein¬ 
fügen und Entfernen von Anweisungen 
aus dem Speicher 



Bild 8.17 

Prinzipielle Struktur des An¬ 
wenderspeichers 

Mj, Programmarken/Programm¬ 
namen; AW Anweisungen; AWZ An- 
weisungszä hierstand 


finden ist, festgelegt (symbolische Adressierung). Bei der Programmaufnahme werden 
Anweisungen mit steigender Folge im Speicher abgelegt; ihre Adressierung geschieht mit 
Hilfe des Anweisungszählers. Bei der Wiedergabe erfolgt die Abarbeitung der Anweisun¬ 
gen in der gespeicherten Reihenfolge; ein Verlassen dieser Folge ist nur bei Ausführung 
eines Verzweigungsbefehls möglich (s. Tafel 8.8). 

Das Format einer Anweisung wird im Bild 8.18 gezeigt. Eine Anweisung besteht gene¬ 
rell aus einer Geometrie- und einer möglichen Ablaufanweisung. Die Geometrieanwei- 
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sung enthält die zu einem bestimmten Anweisungszählerstand zugeordneten Wegedaten 
für alle Achsen, während die Ablaufanweisung aus Befehlen entsprechend dem Befehls¬ 
satz der Steuerung besteht. Bis auf die prozeßsynchrone Aufzeichnung von binären Ein¬ 
gangssignalen erfolgt die Programmierung von Ablaufanweisungen im Sinne des Ein¬ 
fügens von Anweisungen/Befehlen. Zur Vereinfachung der internen Verarbeitung von 
8 Bit 






Geometrie - 
anweisung 


Ab/auf- 

anweisunp 





QuerparitSt ( 1 Bit Je Byte) 


'Information über die Anweisungslänge 
.Längspari tat für Anweisungslänge 


I Wegedaten 
1 2 Byte je Achse 


Befehle 


Längsparitäf für Geometrie - und 
Ablaufanweisung 


Bild 8.18 

Aufbau einer Anweisung 
I Anweisungszählerlänge; 
m Anzahl der Achsen; Bsyte 
Anzahl der für die Speicherung 
von Befehlen zur Verfügung 
stehenden Speicherbyte in 
einer Anweisung 


Anweisungen, vor allem bei der Suche nach Marken in einem abgeschlossenen Pro¬ 
gramm, ist jeder Anweisung eine Information über ihre Länge vorangestellt. Um die Zu¬ 
verlässigkeit des Gesamtsystems zu erhöhen, werden bei der Speicherung der Anweisun¬ 
gen eine Reihe von zusätzlichen Informationen zur Datensicherung abgelegt. Generell 
wird für jedes Byte ein Paritätsbit erzeugt und gespeichert (Querparität). Außerdem 
werden der Information über die Länge der Anweisung und dem Block, bestehend aus 
Geometrie- und Ablaufanweisung, je ein Byte angefügt (Längsparität). Mit dieser Maß¬ 
nahme läßt sich bei der Wiedergabe ein auftretender „Einbitfehler“ in der Information 
über die Länge der Anweisung und innerhalb des Blockes Geometrie- und Ablaufanwei¬ 
sung automatisch korrigieren. Fehler, die durch „Mehrbitfehler“ bedingt sind, werden er¬ 
kannt und je nach Lokalisation eine entsprechende Reaktion ausgelöst. 

Die Programme zur Interpretation und Ausführung der Anwenderbefehle (Ablaufanwei¬ 
sungen) realisieren den Befehlssatz der Steuerung und beziehen sich hauptsächlich auf die 
Verarbeitung von binären Eingangssignalen und der Ausgabe von Binärinformationen an 
den Prozeß über die Hardwarekomponenten DES 12 und DA-R. In Tafel 8.4 ist die 
mnemotechnische Darstellung der Befehle und Operanden und die Kodierung der Befehle 
in sedezimaler Schreibweise angegeben. Die interne Kodierung der Operanden LTE, 
LTA, PNR, ZEIT und TAKT ist in Tafel 8.5 dargestellt und dient in dieser Form zur 
programmtechnischen Realisierung der Anwenderbefehle. 

Im ersten Byte des Operanden LTE ist die Anzahl der in einer disjunktiven Normal¬ 
form konjunktiv und disjunktiv zu verknüpfenden Eingangsleitungen vorangestellt. Mit 
einem Befehl lassen sich bis zu 128 Eingangsbelegungen verknüpfen. Im Beispiel ist dies 
für sechs Verknüpfungen gezeigt. Im Bit 5 des Operanden ist der Operator für die Nega¬ 
tion und im Bit 6 der Operator für die nächstfolgende Operation abgelegt. Sowohl in die¬ 
sem als auch bei allen anderen Operanden gibt eine 1 im Bit 6 des letzten Byte das Ende 
des Operanden an. In Tafel 8.5 wird der Operand LTA für eine binäre Ausgabe gezeigt. 
In den Bits 0 bis 4 ist jeweils die binäre Kodierung des auszugebenden Kanals (Ausgangs¬ 
leitung) abgelegt, während Bit 5 festlegt, ob der Kanal ein- oder ausgeschaltet werden soll. 
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Tafel 8.4. Sedezimale Kodierung der Befehle der Steuereinrichtung ursalog 5021 
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Tafel 8.5. Interne Kodierung der Operanden LTE, PNR, ZEIT und TAKT 
Operand At/gemeiner Aufbau Kodierungsbeispie! 
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Der 1-Byte-Operand PNR läßt die Auswahl von maximal 128 Einzelprogrammen bzw. 
Marken in einem Anwenderprogramm zu. Außerdem sind in Tafel 8,5 die Operanden für 
die Befehle angegeben, die ein zeitweiliges Stillsetzen des Anweisungszählers bewirken. 

Das Programmpaket zur Archivierung des Roboterprogramms auf Kassettenmagnet¬ 
bandgerät ermöglicht den blockweisen Datentransfer zwischen dem Anwenderspeicher 
und dem Bandgerät K5200 [8.25]. Zur Vermeidung von Übertragungsfehlern erfolgt ein 
Kontrollesen der aufgenommenen Daten beim Aufzeichnen (read after write). Zusätzlich 
wird bei der Aufzeichnung eines Blockes ein CRC-Zeichen (cycling redundancy checking) 
gebildet und im Anschluß an die auf Band abgespeicherten Daten als 2-byte-Wort ab¬ 
gelegt. Beim Lesen des Blockes vom Band wird erneut das CRC-Zeichen gebildet und mit 
dem gespeicherten verglichen. Bei Übereinstimmung werden die Daten als gültig erkannt 
und in den Anwenderspeicher übergeben. Im anderen Fall erfolgt eine Fehlerkorrektur 
durch nochmaliges Lesen der Daten vom Band. Ist nach einer bestimmten Anzahl von 
Wiederholungen keine Übereinstimmung der CRC-Zeichen zu erreichen, wird eine Feh¬ 
lermeldung ausgelöst. 

Funktionsumfang des Slaves 1 

Der Slave 1 dient als Bedienrechner zur Kommunikation mit dem Bediener/Program¬ 
mierer; seine Hardwarekomponenten sind im Bild 8.19 dargestellt. Mit Hilfe einer alpha¬ 
numerischen Tastatur werden alle Bedienhandlungen (außer Not-Aus) durchgeführt. 



Bild 8.19 

Hardwarestruktur von 
Slave 1 


Alpha-numerische Tastatur K7632 

während die Ausgabe von Kurztexten, die Anzeige von eingegebenen Kommandos und 
typischen Zuständen der Steuereinrichtung (z.B. Fehlermeldungen) über eine alpha¬ 
numerische Anzeigezeile mit 5 x 7-Punktmatrix-Anzeigeelementen erfolgt. Die An¬ 
schlußsteuerung K7632 dient zur Ansteuerung der Tastatur K7632 und der 32stelligen 
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Kleinanzeige ANK 7521, während die Kartenbaugruppe OFS K3620 zur Speicherung 
der benötigten Verwaltungsprogramme benötigt wird. 

Die Softwarekomponenten realisieren die im Rahmen der Bedienerführung vorgesehene 
Menütechnik mit der dafür notwendigen umfangreichen Zeichenkettenverarbeitung und 
Textanzeige. Mit Hilfe von Verzweigungstabellen werden die in einer Baumstruktur an¬ 
geordneten Ebenen der einzelnen Aktionsprogramme erreicht. 


Funktionsumfang des Slaves 2 

In der Phase der Programmaufnahme dient Slave 2 zur Aufbereitung der von den Meß¬ 
systemen des kinematischen Systems gewonnenen Informationen und übergibt diese zur 
zeitäquidistanten Speicherung dem Master. In der Wiedergabephase erhält er die gespei¬ 
cherten Werte der Bahnkurve (Stützwerte) und generiert zusätzliche Bahnpunkte. Stütz¬ 
werte und zusätzliche Bahnpunkte fungieren als Sollwerte für die Servoregelung. 



Anschluß von maximal 8 potein- 
tiomefrischen Meßsystemen 


51^ Servoventil 


Bild 8.20 

Hardwarestruktur von Slave 2 
5K Servoventil 


Die Hardwarestruktur des Slaves 2 ist im Bild 8.20 dargestellt. Die analoge Meßwert¬ 
erfassung erfolgt mit Hilfe von zwei Anschlußeinheiten für passive Geber (AE-PG). In 
einer Modifizierung sorgen sie für die Bereitstellung einer hochstabilen Versorgungs¬ 
spannung für die Meßpotentiometer (Plastschichtpotentiometer). Zur möglichst voll¬ 
ständigen Ausnutzung des Auflösebereichs des Analog-Digital-Wandlers bei einge¬ 
schränktem Betätigungswinkel der Potentiometer (direkter Einbau der Meßsysteme in die 
Gelenke des Roboters) erfolgt auf den obengenannten Anschlußeinheiten eine entspre¬ 
chende Korrektur. Die schaltungstechnische Konzeption sowohl der Anschlußeinheiten 
für passive Geber als auch die der Grundkarte (AE-G) mit dem 8-Kanal-Analogmulti- 
plexer, dem Instrumentationsverstärker und dem 12-bit-Analog-Digital-Wandler sorgen 
für eine hohe Gleichtaktunterdrückung. Die Kartenbaugruppen DA 2 dienen zur Bereit- 
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Stellung der Spannung für die Geschwindigkeitssollwerte und in Verbindung mit den 
Vorsätzen VDA 2 zur Stromansteuerung der Servoventile. Die Informationsbreite der 
errechneten Geschwindigkeitssollwerte beträgt 8 Bit. Die programmtechnischen Kom¬ 
ponenten des Slaves 2 bestehen vor allem aus der für die Servoregelung (Lageregelung) 
einschließlich Positionsmeßwerterfassung und Geschwindigkeitssollwertausgabe und der 
für die Interpolation. 

Die Programme für die Servoregelung, die ein proportionales Verhalten der einzelnen 
Regler realisieren, sind nur in der Betriebsart „Wiedergabe“ aktiviert und garantieren eine 
stetige Ausgabe von Geschwindigkeitssollwerten im Zeitraster von 10 ms. Die Verstär¬ 
kungsfaktoren für die den einzelnen Achsen zugeordneten Regler werden im Rahmen der 
Grundinitialisierung einmalig in den Abbildspeicher der Steuerung eingeschrieben und 
können während des Betriebs je nach der Stellung des kinematischen Systems verändert 
werden (adaptive Regelung). Die Sollwerte für die einzelnen Regler werden durch den 
Interpolator oder durch direkte Verwendung der aktuellen Positionsistwerte bereit¬ 
gestellt. Das verhindert ein unkontrolliertes Verhalten der Kinematik nach dem Ein¬ 
schalten der Betriebsart Wiedergabe und bei Anfahrstrategien. Zur Realisierung der 
Interpolation 3. Grades (Einfügen von Ästen einer Parabel 3. Grades zwischen den 
Stützstellen) ist die Kenntnis von jeweils vier Stützstellen notwendig. Diese werden durch 
den Master gemeinsam mit dem Kommando „Interpolation“ an den Slave 2 übergeben 
und dort zwischengespeichert. Anschließend erfolgt die Generierung der durch den Takt¬ 
teiler vorgegebenen Anzahl von Zwischenwerten im zentralen Intervall und deren Über¬ 
gabe an den Lageregler. Die zeitliche Aufeinanderfolge der Stützwertbereitstellung aus 
dem Arbeitsspeicher (Roboterprogramm) des Masters erfolgt entweder intern oder extern 
taktgesteuert. Letztere Möglichkeit erlaubt die Zeitraffung bzw. die Zeitdehnung gegen¬ 
über dem Zeitbezug der aufgenommenen Bahn. 




Anhang 


Al. Numerisches Steuerungssystem CNC 600 

Die CNC 600 ist ein numerisches Bahnsteuerungssystem, mit dem technologische Vor¬ 
gänge und Bewegungen vorzugsweise an Dreh-, Bohr-, Fräsmaschinen und Bearbeitungs¬ 
zentren gesteuert werden können. 

Es können maximal fünf NC-gesteuerte Achsen bewegt werden, wobei die Interpola¬ 
tionsarten 2-D-linear und zirkular, 3-D-linear und Helixinterpolation realisiert sind. 

Die Meßauflösung in den Achsen beträgt 0,001 mm bzw. 0,001°. Als Meßsysteme kön¬ 
nen sowohl phasenzyklisch-induktive (Linearinductiosyn, Rundinductosyn, Resolver) als 
auch inkrementale (translatorisch, rotatorisch) verwendet werden, die in zahlreichen 
Varianten miteinander kombiniert werden können. Über D/A-Wandler-Ausgänge kön¬ 
nen die Gleichstromachsantriebe angesteuert werden. Die maximalen Verfahrensgeschwin¬ 
digkeiten (Eilgang) liegen bei 20m-min“F 

Zur Realisierung der Anpaß- und weiterer Funktionen besitzt die CNC 600 eine inte¬ 
grierte, auf Mikrorechnerbasis realisierte PMC. Nur die eigentliche Ein-/Ausgabe-Steue- 
rung (PEAS) ist außerhalb des Steuerungsschranks (Logikschrank)^ im Leistungsteil der 
Maschine untergebracht. 

Eine komfortable Handhabung der Steuerung in allen Modi wird auf der Basis eines 
leistungsfähigen Bedien- und Anzeigekomplexes, der durch Bildschirm und ein umfang¬ 
reiches Programmsystem unterstützt wird, erreicht. 

Für Maschinensteuerfunktionen ist auch eine Zweistationenbedienung möglich. In den 
Steuerschrank ist der Leser zur Lochstreifeneingabe eingebaut; eine Steckdose für den 
Stanzer befindet sich in der Außenwand des Schrankes. Über einen On-line-Anschluß kann 
die CNC 600 in ein übergeordnetes Steuerungssystem integriert werden. Steuerungs¬ 
inbetriebnahme, Inbetriebnahme von Anwenderprogrammen und Steuerungsdiagnose 
erfolgen ohne zusätzliche Geräte mit den Mitteln der Steuerung. 

Die Vielzahl der möglichen Steuerungsvarianten läßt sich den beiden großen Gruppen 
„CNC 600 Bohren/Fräsen“ und „CNC 600 Drehen“ zuordnen. 

Für Anwenderprogramme stehen für Varianten des Typs Bohren/Fräsen maximal 
32 KByte Werkstückprogrammspeicher (ungestützt), maximal 5 KByte Unterprogramm¬ 
speicher (gestützt) und maximal 16 KByte PMC-Programmspeicher (EPROM) zur Ver¬ 
fügung. 

Bei der Variante Drehen liegen diese Werte bei maximal 8 KByte für Werkstückpro¬ 
grammspeicher (gestützt), maximal 6 KByte Unterprogrammspeicher (gestützt) und 
maximal 16 KByte PMC-Programmspeicher (EPROM). 

Das Steuerungssystem CNC 600 konfiguriert sich aus 

- Logikschrank, 

- Prozeß-Ein-/Ausgabe-Steuerung PEAS, 

- Maschinensteuertafel, 

- Verbindungsleitungen. 
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Bild Al.l veranschaulichtdieTeiledesGesamtsystems.DieProzeß-Ein-/Ausgabe-Steue- 
rung ist für den Einbau in das Leistungsteil bestimmt. Die Maschinensteuertafel kann 
extern und/oder intern (d. h. am Logikschrank) angeordnet werden. Während der Loch¬ 
streifenleser fest im Logikschrank eingebaut ist, befindet sich in der Außenhaut des Logik¬ 
schranks eine Steckdose für den Anschluß eines Lochstreifenstanzers (Kabellänge 3 m). 


zum übergeordneten 
Rechner 



- die Elektronik sowie die Bedienelemente (Taster, Drehwahlschalter) und Anzeige 
(Bildschirm) zur Korrespondenz mit dem Bediener; die Bedienblende des Steuerungs¬ 
schranks ist dabei unterteilt in eine Datentafel und in eine wahlweise am CNC-Schrank 
angebrachte Maschinensteuertafel (Variante Bohren/Fräsen); 

- die Elektronik zur Korrespondenz mit der Datenverarbeitungsperipherie (eingebauter 
Lochstreifenleser, anschließbarer Stanzer) und einem übergeordneten Rechner in On¬ 
line-Anschluß ; 

- die Elektronik zur Bedienung der prozeßseitigen Peripherie (PEAS, Meßsysteme, An¬ 
triebe) ; 

- die gesamte Elektronik zur internen Datenverarbeitung, wobei die Anpaßsteuerung als 
programmierbare Steuerung (PMC) in den Steuerschrank integriert ist; die PMC kor¬ 
respondiert über einen bidirektionalen Datenkanal mit der PEAS; 

- Stromversorgung für die gesamte Logik sowie die Meßsysteme. 

Die Prozeß-Ein-jAusgabe-Steuerung (PEAS) realisiert die Ein-/Ausgabe von digitalen 
Signalen vom/zum Prozeß sowie die Ausgabe einer Analogspannung für die Steuerung 
des Hauptantriebs der Werkzeugmaschine. Sie besitzt eine eigene Stromversorgung sowie 
eine Lüfterbaugruppe und ist konstruktiv als Einbauvariante gestaltet. 

Die externe Maschinensteuertafel kann auch vorhanden sein, wenn am Logikschrank be¬ 
reits eine solche angebracht ist. Sie ist konstruktiv als Einbauvariante ausgeführt. 

Die die Komponenten des Systems verbindenden Leitungen einschließlich derjenigen 
zu Meßsystemen und Antrieben haben eine maximale Länge von 50 m. Die Verbindungs¬ 
leitung zum übergeordneten Rechner (On-line-Anschluß) kann eine Länge bis zu 500 m 
besitzen. 
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Al.l. Gerätetechnik des Logikschranks 

Das im Bild Al.2 dargestellte Blockschaltbild vermittelt einen Überblick über die im 
Logikschrank der CNC 600 realisierten Funktionsmoduln, aus dem auch grob die Funk¬ 
tion, die nachfolgend genauer erläutert wird, zu erkennen ist. Das gesamte System stellt 
eine Multimikrorechneranordnung aus maximal neun Mikrorechnern, die alle auf der 
Basis des Mikrorechnersystems U880 aufgebaut sind, dar. 
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Bild Al.l. Blockschaltbild der CNC 600 (Logikschrank) 
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Die Gesamtanordnung läßt sich in einzelne Teilkomplexe unterteilen, die jeweils ein¬ 
zelnen Mikrorechnern bzw. Mikrorechnergruppen zuzuordnen sind: 

- Komplex Leitrechner, 

- Komplex Bedienblendenrechner, 

- Komplex Wegesteuerungs- und Lageregelungsrechner, 

- Komplex PMC-Rechner. 

Das Zusammenwirken des Rechners wird durch die Rechnerkopplungen realisiert. Die 
Funktion der Steuerung in ihren verschiedenen Betriebsarten wird durch die in den ein¬ 
zelnen Rechnern fest installierten (residenten) bzw. vorübergehend geladenen (flüchtigen) 
Programmsysteme bestimmt. 


Al.2. Komplex Leitrechner 

Im Rahmen des Steuerungssystems hat der Komplex Leitrechner folgende Funktionen zu 
erfüllen: 

Kommunikationsfunktionen 

- Kommunikation mit dem Bediener und der DV-Peripherie, 

- Kommunikation mit den angeschlossenen Slaverechnern für 

- Wegesteuerung und PMC; 

Informationsverarbeitungs- und Steuerungsfunktionen 

- Ablaufsteuerung (Realisierung der Anpaßbedingungen), 

- Satzaufbereitung (Realisierung der Programmieranleitung), 

- Organisation der Bedienung und Anzeige (Realisierung der Bedienanleitung); 

Speicherfunktionen 

- Speicherung von Werkstückprogrammen, 

- Speicherung von technologischen und werkstückspezifischen Unterprogrammen, 

- Speicherung von Korrekturdaten, 

- Speicherung von Generierdaten; 

Systemüberwachungsfunktionen. 

Kern der Hardware dieses Komplexes ist die zentrale Recheneinheit K2521 [8.1]. An 
dem von ihr gebildeten standardisierten Systembus [8.3] arbeiten die zugeordneten Spei¬ 
chermoduln und Anschlußsteuerungen (AS). Über das auf den Mikrorechnern K2521 
installierte Mehrrechnerkopplungsinterface arbeitet die Leitrechner-ZRE als Master mit 
den ebenfalls aus K2521 realisierten Rechnern für Wegesteuerung PMC (jeweils Slaves) 
zusammen. Die Mehrrechnerkopplungsinterfaces bilden den Koppelbus, auf dem die 
Kommunikation der genannten Rechner erfolgt. 

Als Speichermodule für die genannten Speicherfunktionen fungieren Steckeinheiten 
aus dem System Kl520 [8.1]: 

K3521 4 KByte CMOS-RAM mit Batteriestützung der Information auf der Steckeinheit 
und Schaltung zur Überwachung der Stützspannung (für Unterprogramme, Kor¬ 
rektur- und Generierdaten, Werkstückprogrammspeicher bis 8 KByte, PMC- 
Programme während Inbetriebnahmephase); 
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K3525 16 KByte DRAM mit entsprechenden Bestückungsvarianten 12 KByte und 
8 KByte (für Werkstückprogrammspeicher bis 32 KByte); 

K3820 16 KByte EPROM ; EPROM-Schaltkreise auf Sockel, so daß Bestückungsvarian¬ 
ten in Stufen von 1 KByte möglich sind (Steuerprogrammsystem des Leitrechners, 
PMC-Programm). 

Da der direkt adressierbare Speicherraum des U880 von 64 KByte nicht ausreicht, 
wird mit Speichererweiterung mittels der Signale MEMDI 1/ und MEMDI 2/ (s. [8.1]) 
gearbeitet. Die Kommunikation mit der Peripherie erfolgt über Anschlußsteuerungen. 
Die Steckeinheit AS Bedienung/Leser/Stanzer enthält die Anschlußsteuerungen zum Be¬ 
dienkomplex der CNC 600, zum eingebauten fotoelektrischen Lochstreifenleser FS 330 
(Lesegeschwindigkeit 300 Zeichen/s) und zum Stanzer. Über den Stanzeranschluß sind die 
Stanzertypen DT 105S, Facit 4070 (Parallelschnittstelle) und daro 1215 (KME3-Pegel und 
TTL-Pegel) ansteuerbar. 

Der Verkehr mit Leser und Stanzer erfolgt nach dem Abfrageprinzip (Polling), mit dem 
Bedienblendenkomplex nach dem Interruptverfahren. Die AS ANA ist die Anschluß¬ 
steuerung für die alphanumerische Anzeige, für die die Bildschirmeinheit ANA440S 
(Bildschirmdiagonale 31 cm) verwendet wird. Sie dient als universelle Anzeige in allen 
Betriebsarten und Modi der Steuerung. 

Die AS ANA ermöglicht die Anzeige von 64 beliebigen Zeichen im 5 x 7-Punktraster 
sowie einer Marke in Doppelstrichform. Die Anzeigeformate 8 Zeilen zu 32 Zeichen bzw. 
10 Zeilen zu 48 Zeichen sind über Programm umschaltbar. 

Die Steckeinheit PRE/DNC realisiert zwei serielle Schnittstellen mittels U856, die un¬ 
abhängig voneinander wahlweise als IFSS (/nter/ace sternförmig seriell) oder als V.24 
geschaltet werden können. Die Übertragungsrate ist durch einen Baudratenspeicher ein¬ 
stellbar und kann bei IFSS maximal 9600 Baud, bei V.24 maximal 1200 Baud betragen. 
Die maximalen Übertragungsentfernungen betragen für IFS 500 m, für V.24 15 m. Auf 
der Steckeinheit ist außerdem eine Programmspeichererweiterung (PRF) von 4 KByte 
EPROM untergebracht. Mit dieser Steckeinheit wird der DNC-Betrieb (f/irect «umeri- 
cal control) mit einem übergeordneten Rechner ausgeführt (On-line-Anschluß). Der 
EPROM-Programmierzusatz K0420 dient in Verbindung mit dem nachladbaren Pro¬ 
gramm „Monitor 600“ zur EPROM-Programmierung (Uß35) in der Steuerung. 

Die Steckeinheit Überwachung arbeitet als E/A-Baugruppe am Leitrechnerbus und ist 
in die Interruptprioritätskette eingebunden. Sie erfüllt wichtige Funktionen im On-line- 
und Off-line-Diagnosesystem der Steuerung CNC 600. 

Das On-line-Diagnosesystem der CNC 600 ist hierarchisch gegliedert. Die höchste 
Priorität haben Hardwareüberwachungen mit direkter Wirkung auf Not-Aus, wobei kein 
funktionierender Rechner benötigt wird. Dazu gehören die Stromversorgungs- und Takt¬ 
überwachung. 

In der zweithöchsten Ebene erfolgt eine Hardwareüberwachung der Leitrechnerfunk¬ 
tionsfähigkeit ebenfalls mit direkter Wirkung auf Not-Aus. 

In der dritten Ebene laufen die Softwareüberwachungsfunktionen, wobei die Steck¬ 
einheit insbesondere Hardwareunterstützung für einige wichtige Funktionen liefert, wie 
z. B. die Überwachung des richtigen Bussignalspiels am Leitrechnerbus, die Stützspan¬ 
nungsüberwachung der CMOS-Steckeinheiten, die Lüfterüberwachung. 

Das System der Softwarediagnose ist bei der.CNC 600 weit ausgebaut und bietet hohen 
Komfort und Sicherheit bei der Handhabung der Steuerung. 

Im Rahmen der Off-line-Diagnose stellt die Steckeinheit Überwachung besondere 
Signale zur Diagnose wichtiger Schnittstellen zur Verfügung. 
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Al.3. Bedien- und Anzeigekomplex 

Der Bedien- und Anzeigekomplex erfüllt im System CNC 600 folgende wesentliche Funk¬ 
tionen : 

- Über Bedienelemente (Taster, Drehwahlschalter) und Anzeigen (Tasterrückmeldun¬ 
gen, 7-Segment-Anzeige bei externer Maschinensteuertafel) ermöglicht er die unmittel¬ 
baren Bedienhandlungen in allen Betriebsarten und Modi der Steuerung. 
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Bild AL3. Blockschaltbild des Bedien- und Anzeigekomplexes 
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- Er organisiert die zyklische Zustandsabfrage der Bedienelemente, führt die Prellunter¬ 
drückung durch, kodiert die Taster- und Drehwahlschalterzustände und bietet sie dem 
Leitrechner an. 

- Er steuert mit Informationen vom Leitrechner die Anzeigeelemente an (die universelle 
Bildschirmanzeige gehört nicht zu diesem Komplex). 

- Er organisiert Umschaltungen und Verriegelungen. 

- Er liefert einen Beitrag zum On-line- und Off-line-Diagnosesystem der Steuerung, so 
z.B. werden durch ihn ermöglicht 

die zweistufige Temperaturüberwachung, 

die Aufrufbarkeit residenter Diagnoseroutinen im Bedienkomplex durch Leitrech¬ 
ner, 

die Prüfbarkeit des RAM- und EPROM-Bereichs des Bedienblendenrechners durch 
den Leitrechner. 

Das Blockschaltbild des Bedien- und Anzeigekomplexes (Bild Al.3) zeigt die einzelnen 
Komponenten und deren grundsätzliches Zusammenspiel. Die zentrale Baugruppe dieses 
Komplexes ist die „Bedienblende Logik“, die einen Mikrorechner auf der Basis des Mikro¬ 
prozessors U880 sowie 0,25 KByte RAM und 1 KByte EPROM enthält. Dieser Rechner 
arbeitet über die Buskoppeleinheit mit dem Leitrechner auf Interruptbasis zusammen. 



Bild Al.4 

Bedienblende CNC 600 
(Werkfoto VEB NKM) 


Die KGB Kabelinterface wird nur bei Vorhandensein einer externen Maschinensteuer¬ 
tafel benötigt und dient der Überbrückung einer Entfernung ^ 50 m. 

Alle Bedien- und Anzeigeelemente sind für den Bediener zu einer Datentafel und einer 
Maschinensteuertafel zusammengefaßt, die eine übersichtliche, einfache und damit 
sichere Bedienung ermöglichen. 
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Während sich die Datentafel immer am Logikschrank befindet, kann die Maschinen¬ 
steuertafel sowohl am Steuerschrank als auch extern angeordnet werden. Die externe 
Maschinensteuertafel ist als Einbauvariante gestaltet. Die Kombination sowohl interne 
als auch externe Maschinensteuertafel ist möglich. 

Bild Al.4 zeigt die Bedienblende der CNC 600, bestehend aus Daten und Maschinen¬ 
steuertafel, für Variante Fräsen. 


Al.4. Wegesteuerimgs- und Lageregelungskomplex 

Die Funktion dieses Komplexes innerhalb des Gesamtsystems besteht darin, die vom 
Leitrechner aufbereitete und an den Wegesteuerungsrechner übergebene geometrische 
und Geschwindigkeitsinformation für die auszuführende Bewegung umzuwandeln in 
Wegsollinformationen, aus denen mit Hilfe der von den Wegmeßsystemen gelieferten 
Istinformationen für jede Achse die Sollwert-Istwert-Differenz gebildet wird, diese analog 
zu wandeln und als Führungsgröße für den dem Lageregelkreis unterlagerten Geschwin¬ 
digkeitsregelkreis vorzugeben. 

Dem Teilkomplex Wegesteuerung werden dabei die Aufgaben Grobinterpolation, Aus¬ 
gaben zu den D/A-Wandlern, Abfrage der Istwertinformationen von den Meßsystemein¬ 
gängen sowie der Datenaustausch mit Leitrechner und Lageregelungsrechnern übertragen. 
In jedem der Lageregelungsrechner werden die Aufgaben Feininterpolation, Sollwert¬ 
glättung, Sollwert-Istwert-Differenzbildung, achsspezifische Korrekturen von Maschinen¬ 
fehlern (Losekompensation, Spindelsteigungskorrektur) sowie Softwareendschalter und 
Achsfehlererkennung für eine Achse gelöst. 

Die wesentlichen Hardwarekomponenten, auf deren Basis die genannten Funktionen 
realisiert werden, sind 

- ZRE K2521 als Wegesteuerungsrechner, der über das Mehrrechnerkopplungsinterface 
(Koppelbus 1) mit dem Leitrechner verbunden ist; 

- Buskopplung, die die Verbindung zur Peripherie (D/A-Wandler, Meßsystemeingänge) 
herstellt und den Datenaustausch mit den Lageregelungsrechnern ermöglicht; 

- Lageregelungsrechner, der eine autonome Recheneinheit auf der Basis des Mikropro¬ 
zessors U880 darstellt; 

- Meßsystemeingänge (MSE), die die Aufgabe haben, die von den Wegmeßsystemen ge¬ 
lieferten Wegeinformationen zu empfangen und so aufzubereiten, daß der aktuelle Ist¬ 
wert gebildet werden kann; es existieren Meßsystemeingänge sowohl für inkrementale 
Geber als auch für phasenzyklische Meßsysteme (Inductosyn, Resolver); 

- D/A-Wandler, die die digitale Sollwert-Istwert-Differenz einer Breite von 15 bit (ein¬ 
schließlich Vorzeichen) in eine analoge Einheitsspannung im Bereich — lOV ^ U 
^ -t-10 V wandeln. 

Die maximale Ausbaustufe ist durch fünf Lageregelungsrechner, fünf D/A-Wandler 
sowie fünf Meßsystemeingangskanäle gekennzeichnet. 


Al. 5. PMC-Komplex 

Mit dem PMC-Komplex wird die freiprogrammierbare Anpassung an die speziellen 
Werkzeugmaschinen als integraler Bestandteil des Steuerungssystems CNC 600 gelöst. 
Die eigentliche Ein-/Ausgabe der Prozeßsignale erfolgt dabei über eine Prozeß-Ein-/ 
Ausgabe-Einrichtung (PEAS), die außerhalb der Steuerung im Leistungsteil der Ma- 
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schine angeordnet ist. Damit wird eine hohe Flexibilität erreicht, die, unterstützt durch 
das leistungsfähige Programmsystem derPMC (s. Abschnitte A1.4. und Al.5.), dem An¬ 
wender ein effektives Erstellen seiner Programme sowie kurze Inbetriebnahmezeiten er¬ 
möglicht. Im unmittelbaren Steuerungsprozeß berechnet die PMC aus vom Leitrechner 
übergebenen Informationen (NC-Signale) und Zustandssignalen von der Maschine 
zyklisch nach einem bestimmten Programm Steuersignale für die Werkzeugmaschine 
(Maschinensignale) und gibt sie über diePEAS aus. In der PMC erfolgt auch die Steuerung 
des Hauptantriebs (Drehzahl- und Getriebestufenberechnung) sowie zusätzlicher Kom¬ 
plexe (z.B. Werkzeugwechsel, Schmierung u.a.). 

Die PMC wird hardwaremäßig realisiert durch eine ZRE K2521, die mit dem Leit¬ 
rechner über das Mehrrechnerkopplungsinterface verbunden ist (Koppelbus 1). Während 
das PMC-Steuerprogramm auf der ZRE K2521 untergebracht ist (3 KByte EPROM), 
steht für das Anwenderprogramm ein Speicherbereich von 16 KByte zur Verfügung. Um 
in der Inbetriebnahmephase Änderungen mit dem Programm „PMC-Dialog“ ausführen 
zu können, wird ein CMOSRAM (K3521) verwendet. Nach Abschluß der Inbetriebnahme 
wird das Programm auf EPROM (K3820) übernommen. 

Auf einer am Systembus des PMC-Rechners (K1520-Bus) steckenden Anschlußsteue¬ 
rung (AS PEAS) wird das serienparallele Interface gebildet, das den bidirektionalen 
Datenverkehr mit der bis zu 50 m entfernten PEAS gerätemäßig abwickelt. Die Über¬ 
tragungsstrecke ist optisch entkoppelt. Über sie erfolgen Übertragungen mit einer Ge¬ 
schwindigkeit von etwa 20 KByte/s. 


Al. 6. Rechnerkopplungen 

Innerhalb der als Multimikrorechnersystem arbeitenden CNC 600 werden unterschied¬ 
liche, den jeweiligen Anforderungen angepaßte Koppelprinzipien zwischen den Mikro¬ 
rechnern verwendet. Das betrifft die Koppelstellen 

- Leitrechner-Bedienblendenrechner, 

- Kopplung über Koppelbus 1, 

- Kopplung über Koppelbus 2. 

Die Kopplung zwischen Leitrechner und Bedienblendenrechner erfolgt über die im 
Bild 8.8 dargestellte Buskoppeleinheit. Diese stellt eine parallele periphere Schnittstelle 
auf Basis der Schaltkreise U855 dar, die mit ihrem Businterface am Systembus des Leit¬ 
rechners angeschaltet sind und vom Bedienblendenrechner erkannte Zustandsänderun¬ 
gen über das Interruptsystem dem Leitrechner melden. Bis zum Abholen der Information 
durch den Leitrechner verharrt der Bedienblendenrechner im WAIT-Zustand. 

Am Koppelbus 1 arbeiten sämtliche K2521-Rechner nach dem Master-Slave-Prinzip, 
wobei der Master (Leitrechner) mit maximal drei Slaves (Wegesteuerungsrechner, PMC- 
Rechner, dritter Slaverechner ist bei CNC 600 nicht benutzt) Zusammenarbeiten kann. 
Der Datenaustausch erfolgt zwischen Master und jeweils einem der Slaves bidirektional 
und kann sowohl vom Master als auch dem Slave initiiert werden. Für die peripherie¬ 
artige Kopplung benötigt jeder der Rechner einen programmierbaren Ein-/Ausgabe- 
Schaltkreis mit paralleler Schnittstelle (U855) und eine Zusatzlogik (ZL), die beide auf 
der Rechnerkarte K2521 installiert sind. Bild ALS zeigt die Anordnung der Rechner am 
Koppelbus 1. Zur Anmeldung eines Sendewunsches bei dem Partner und dessen Quittie¬ 
rung dient der Adressierungs- und Quittungsbus, der aus sechs Leitungen besteht. Für 
den Fall, daß mehrere Slaves Datenaustausch mit dem Master wünschen, nimmt der 
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Master die Priorisierung programmgemäß vor. Treffen Mastersendewunsch und Slave¬ 
sendewunsch aufeinander, dominiert der Master durch Setzen des Masterstatusbits 
(Übertragungsrichtung). Der eigentliche Datenaustausch erfolgt nach Abschluß des Ver¬ 
bindungsaufbaus in Byteblöcken mit vereinbartem Datenbus. Jedes einzelne Byte wird 



dabei im asynchronen Handshake (Handshakebus) vom Sender zum Empfänger über¬ 
geben. Die Zusammenarbeit zwischen der peripheren Schnittstelle und der jeweiligen 
CPU erfolgt auf Interruptbasis. Die Datenübertragung auf dem Koppelbus 1 erfolgt mit 
einer Geschwindigkeit von etwa 30 KByte/s. In die Rechnerkopplungsprogramme sind 
eine Reihe von Überwachungsfunktionen implementiert, die im Fehlerfall zu Fehler¬ 
anzeigen am Bildschirm führen. 

Die Kopplung von Wegesteuerungs- und maximal fünf Lageregelungsrechnern erfolgt 
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über Koppelbus 2 (Bild Al .6). Im normalen Betrieb arbeiten alle beteiligten Rechner auto¬ 
nom. Der Datenaustausch wird stets vom Wegesteuerungsrechner (Master) eingeleitet. 
Zu diesem Zweck enthält Koppelbus 2 neben den Signalen des Wegesteuerungssystem¬ 
busses Aufruf- und Quittungsleitungen. Bei Aufruf eines der Lageregelungsrechner 
trennt sich dessen CPU vom lokalen Bus und quittiert dies. Gleichzeitig wird durch Öff¬ 
nen des Tores der Wegesteuerungsbus auf den Lageregelungsrechner geschaltet und der 
Datentransfer als Speichertransfer der Wegesteuerung durchgeführt. Zu beachten ist da¬ 
bei, daß sich die Adreßräume von Wegesteuerungs- und Lageregelungsrechner nicht 
überlappen. Bei der beschriebenen Art des Datenaustausches wird eine Übertragungs¬ 
geschwindigkeit von mehr als 100 KByte/s erreicht. 


Al. 7. Prozeß-Ein-Ausgabe-Steuerung 

Die Prozeß-Ein-/Ausgabe-Steuerung (PEAS) kann als konstruktiv selbständiger Kom¬ 
plex, bestehend aus Logikteil, Stromversorgung und Lüfterbaugruppe außerhalb des 
CNC-600-Steuerschranks (z.B. im Leistungsteil der zu steuernden Maschine) unter¬ 
gebracht sein. Funktionell dagegen ist sie nicht selbständig, sondern arbeitet mit dem 
PMC-Komplex zusammen. 

Die Hauptaufgaben der PEAS sind die Organisierung der Verbindung zur PMC, die 
nach Kanälen geordnete Durchschaltung der Eingangs- und Ausgangssignale, die Ver¬ 
stärkung der Ausgangssignale auf das erforderliche Niveau zur direkten Ansteuerung von 
Stellgliedern und die Anpassung der Eingangssignale an die internen Pegel. Darüber 
hinaus enthält die PEAS Überwachungseinrichtungen, die die Steuerung bei auftretenden 
Fehlem in den für die Maschine und den Bediener ungefährlichen Zustand bringen. 
Diagnoseeinrichtungen ermöglichen unter Zuhilfenahme von Prüfprogrammen (in PMC) 
das Auffinden der defekten Steckeinheit. 



Eingänge vom Ausgänge zum Bild Al. 7 

Prozeß Prozeß Blockschaltbild der PEAS 

Das Blockschaltbild der PEAS ist im Bild Al.7 dargestellt. Verbindungsbaugruppe 
PV, Grundbaugruppe PG und Überwachungsbaugruppe PÜ müssen als Grundaus¬ 
rüstung stets vorhanden sein. Zahl und Art der Eingabebaugruppen PE und Ausgabe¬ 
baugruppen PA sind dagegen projektierbar. Vom Programm verarbeitbar und adressier¬ 
bar sind maximal 480 Prozeßeingangs- bzw. -ausgangssignale. Konstruktiv stehen 
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20 Steckplätze bei einer Logikkassette bzw. 40 Steckplätze bei zwei Logikkassetten für 
Prozeßeingabe- und -ausgabekarten zur Verfügung. 

Die Stromversorgung der PEAS liefert alle zum Betreiben der PEAS-Steckeinheiten 
notwendigen Spannungen einschließlich der Versorgung der Eingabeelemente im 24-V- 
Pegel. Die Versorgung der Stellglieder und der Eingabeelemente für 110 V Ws ist vom 
Anwender bereitzustellen. 

Die Logik der PEAS ist in CMOS-Technik ausgeführt. 

Jeder Ein-/Ausgabe-Modul der PEAS besitzt eine Einzelbitanzeige mittels Lumines¬ 
zenzdioden und einen steckbaren Einzelbitanschluß. 


A1.8. Software des Steuerimgssystems CNC 600 

Die Software des Systems CNC 600 gliedert sich in 

- Steuerprogrammsystem, 

- Anwenderprogramme, 

- Serviceprogrammsystem. 

Diese Programme sind den Speicherbausteinen der einzelnen Mikrorechner der Steue¬ 
rung zugeordnet. 

Das Steuerprogrammsystem realisiert den NC-spezifischen Funktionsinhalt der Steue¬ 
rung (Funktionsprogramme) und ist auf EPROM abgelegt (residente Programme). Zur 
Abarbeitung der einzelnen Steuerprogramme werden außerdem in jedem Mikrorechner 
interne Arbeitsspeicher und Datenfelder als RAM-Bereiche benötigt. 

Die Anwenderprogramme stellen die abzuarbeitenden Eingabedaten für die Steuer¬ 
programme dar. Sie gliedern sich in die Werkstückbearbeitungsprogramme (geometrische 
und technologische Daten für das zu bearbeitende Werkstück) und die Anpaßprogramme 
(Beschreibung der Signalverknüpfung an der Schnittstelle Steuerung-Maschine). Die 
Anwenderprogramme werden je nach Ausführungsvariante der Steuerung in dynamische 
oder batteriegestützte statische RAM (CMOS-RAM) eingelesen. Das Anpaßprogramm 
kann auch auf EPROM programmiert werden. 

Das Serviceprogrammsystem dient zur Unterstützung von Inbetriebnahme-, Wartungs¬ 
und Fehlersucharbeiten. Durch Doppelausnutzung von RAM-Bereichen ist eine Vielzahl 
von Serviceprogrammen einzeln nachladbar (nachladbare Programme). Die Service¬ 
programme belegen nach dem Einlesen einen Teil der RAM-Speicher, in die sonst Werk¬ 
stückbearbeitungsprogramme eingelesen werden. Das hat zur Folge, daß in diesem Fall 
der normale NC-Betrieb der Steuerung nicht oder nur eingeschränkt möglich ist. 


Al. 9. Steuerprogrammsystem 

Jeder Rechner des Multimikrorechnersystems der Steuerung realisiert durch die ihm fest 
zugeordneten Steuerprogramme bestimmte Funktionskomplexe. 

Jeder Rechner arbeitet seine Funktionsprogramme autonom ab. Leitrechner, Wege- 
steuerungs- und PMC-Rechner können untereinander programmierten Datenaustausch 
durchführen, während der Wegesteuerungsrechner durch DMA (direkter Speicherzugriff) 
zu den Speichern der Lageregelungsrechner Zugriff hat. Der Programmablauf wird in 
jedem Rechner eigenständig und nach einem der jeweiligen Funktion angepaßten Prinzip 
organisiert. 

Der Leitrechner arbeitet nach dem Interruptprinzip. Die Meldungen der Slaves sowie 
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die des Bedienblendenrechners (Bedieninformationen) und einige Fehlersignale des 
Überwachungssystems werden über Interruptprogramme erfaßt und ausgewertet. Die 
daraufhin notwendigen Reaktionsprogramme zur Informationsverarbeitung und zum 
Informationstransport werden von den Interruptprogrammen in drei Wertigkeitsebenen 
angemeldet und nach dem Warteschlangenprinzip abgearbeitet. 

Wichtige Leitrechnerprogrammkomplexe werden nachfolgend kurz erläutert. 

Das Betriebssystem organisiert den Steuerprogrammablauf im Leitrechner, wertet 
Fehlersignale der Überwachungsbaugruppe aus, steuert den Datenaustausch mit Wege¬ 
steuerung und PMC, mit Leser und Stanzer und nimmt die Einschaltinitialisierung vor. 

Das Programm Grunddiagnose diagnostiziert nach dem Einschalten den Hardcore des 
Leitrechners und gibt ggf. Fehlermeldungen im Klartext über den Bildschirm aus. 

Der Programmkomplex Geometrieberechnung stellt eine Unterprogrammbibliothek 
zur Schnittpunktberechnung geometrischer Formelelemente dar. Diese Formelemente 
werden beim Einlesen des Werkstückprogramms aufgelöst oder müssen zur Definition 
der äquidistanten Bahnkurve bei Fräserradiuskorrektur berechnet werden. 

Die Standardunterprogramme stellen eine Programmbibliothek für arithmetische Be¬ 
rechnungen im Fest- und Gleitkommaformat bzw. für die Konvertierung von Wortfor¬ 
maten dar. 

Das Programm Maschinensteuertafel realisiert die Bedienfunktionen der Maschinen¬ 
steuertafel einschließlich der Bildschirmanzeigen in den einzelnen Betriebsarten der 
Steuerung. 

Das Programm Ablaufsteuerung wertet die Meldungen von Wegesteuerung und PMC 
aus und führt die entsprechenden Reaktionen einschließlich der Ausgaben an Wege¬ 
steuerung und PMC aus beziehungsweise meldet sie an (Satzaufbereitung). 

Im Programm Satzaufbereitung werden das Werkstückbearbeitungsprogramm satz¬ 
weise dekodiert und die internen Satzpuffer gefüllt. 

Im Programm NC- Vorbereitung werden die internen Satzpufferinformationen zur Aus¬ 
gabe vorbereitet, indem die Fräserradiuskorrektur über die Geometrieberechnung in die 
Bezugsmaße eingerechnet und die Vorschubkonstante gebildet wird. 

Informationen für die Wegesteuerung werden ausgegeben. 

Das Programm Datentafel erledigt alle Bedienfunktionen der Datentafel einschließlich 
zugehöriger Bildschirmanzeigen. 

Das Einleseprogramm realisiert die Eingabe, Syntaxkontrolle und Abspeicherung der 
Werkstückbearbeitungsprogramme über Lochstreifenleser oder Tastatureingabe und ruft 
erforderlichenfalls die Geometrieberechnung auf. 

Das Programm Istwerterfassung wertet zyklisch die Wegistwerte der Wegesteuerung 
aus zur Anzeige, Achsfehlererfassung sowie für die drehspezifischen Funktionen Um¬ 
drehungsvorschub und konstante Schnittgeschwindigkeit. 

Das Programm Schnittaufteilung realisiert die automatische Schnittaufteilung für die 
Technologie Drehen, indem in Abhängigkeit von den Istkoordinaten Verfahrbewegungen 
generiert werden. 

Das Steuerprogramm der PMC arbeitet zyklisch die Interpretation der Booleschen 
Gleichungen und die Assemblerprogramme ab und führt die Abfrage der Eingänge und 
das Setzen der Ausgänge aus. Dieser Zyklus wird nur unterbrochen von den Interrupt¬ 
programmen der Rechnerkopplung oder von einem kurzen CTC-Interruptprogramm zur 
Realisierung der Zeitglieder. Als Assemblerprogramme sind die Programme für Werk¬ 
zeugwechsel, Spindelsteuerung und Schmierung realisiert. 

Aufgrund der zyklischen Arbeitsweise ergibt sich eine vom Steuerungsumfang abhän¬ 
gige Zykluszeit der PMC (etwa 10 ms je 1 KByte Anwenderprogramm). 
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Das Steuerprogrammsystem der Wegesteuerung untergliedert sich in Hinter- und Vor¬ 
dergrundprogramme. Während der Abarbeitung der zur Informationsaufbereitung stän¬ 
dig ablaufenden Hintergrundprogramme unterbricht ein 2,5 ms-Takt (CTC-Interrupt) 
diese Abarbeitung regelmäßig und stößt zyklisch verschiedene Zweige des Vordergrund¬ 
programms an, das die Ein- und Ausgaben mit den Meßsystemeingängen bzw. D/A- 


Lochstreifen/eser, Tastatur Bifdschirm 
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Bild Al.8. Informationsfluß in der CNC 600 
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Wandlern realisiert. Die Interruptprogramme der Rechnerkopplung zum Leitrechner un¬ 
terbrechen den Hintergrund, werden aber selbst vom Vordergrundprogramm unter¬ 
brochen. 

Das Steuerprogramm Lageregelungsrechner besteht aus den Teilen Sollwertberechnung 
und Sollwert-Istwert-Vergleich, die jeweils taktsynchron vom Vordergrundprogramm 
der Wegesteuerung gestartet werden und in einer Warteschleife enden. 

Das Programm des Bedienblendenrechners läuft zur Abfrage der Taster- und Wahl¬ 
schalterstellungen bzw. zur Meldung von Kodierungen zyklisch ab. 

Der durch das Steuerprogrammsystem erzeugte Informationsfluß ist schematisch im 
Bild Al.8 dargestellt. Er enthält alle wichtigen Speicherbereiche, in denen NC-Daten ge¬ 
speichert bzw. auf bereitet werden. 

Steuerinformationsspeicher sind der Übersichtlichkeit halber nicht dargestellt. Steuer¬ 
signale, die die Informationsverarbeitung bzw. den Informationstransport auslösen, ent¬ 
stehen bei Bedienhandlungen, Prozeßzustandsänderungen, bei Auswertung bestimmter 
Daten oder durch Rechnerkopplung. 


Al. 10. Serviceprogrammsystem 

Das Serviceprogrammsystem besteht aus den Teilsystemen 

- Monitorprogramm, 

- Generierungsprogramm, 

- Diagnoseprogramm, 

- PMC-Dialog, 

- PMC-Dokumentation, 

die nachfolgend kurz bezüglich ihres Inhalts erläutert werden. 

Das Monitorprogramm dient dem Anwender vor allem zum Duplizieren von Lochstrei¬ 
fen, zum Lochstreifenvergleich mit EPROM-Inhalten sowie in Verbindung mit dem 
EPROM-Programmierzusatz K0420 zum Programmieren von EPROM. Außerdem ist 
mit diesem Programm das Anzeigen von Speicherinhalten sowie das Ausstanzen und 
Wiedereinlesen des Anpaßprogramms der PMC im Maschinenkode möglich. 

Das Generierungsprogramm dient bei der Inbetriebnahme der Steuerung dazu, steue- 
rungs- und maschinenspezifische Daten (Generierungsdaten) eingeben bzw. ändern zu 
können. Nach der Generierung der Steuerung werden die neuen Generierdaten (in der 
Steuerung auf gestütztem CMOS-Speicher abgelegt) durch Ausstanzen fixiert. 

Das Diagnoseprogrammsystem besteht aus einem Diagnosebetriebssystem und einer 
Menge von Testroutinen zur Diagnostizierung der Steuerungsbaugruppen. Die Diagnose¬ 
routinen können einzeln oder nacheinander in einer logischen Reihenfolge eingelesen 
werden. Sie werden unter Steuerung des Diagnosebetriebssystems abgearbeitet. Das 
simultane Abarbeiten von Werkstückprogrammen ist nicht möglich. Dieses Off-line- 
Diagnosesystem stellt neben den On-line-Überwachungen und -diagnosen und dem Ein¬ 
schaltdiagnoseprogramm einen wesentlichen Teil des gesamten Diagnose- und Über¬ 
wachungssystems der CNC 600 dar. Es dient insbesondere im Fehlerfall zu einer schnel¬ 
len Lokalisierung der fehlerhaften Baugruppe. 

Mit Hilfe des PMC-Dialogs läßt sich das vom Anwender erstellte Anpaßprogramm in 
die PMC einiesen. Dabei erfolgen Syntaxkontrolle und Konvertierung. Auftretende Feh¬ 
ler sowohl beim Einlesen als auch beim Abarbeiten des PMC-Programms lassen sich 
durch Zustandsanzeigen orten und über Kommandos korrigieren. Der PMC-Dialog 
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existiert zusätzlich in einer abgerüsteten Version für Servicezwecke. Die Anwendung 
des PMC-Dialogs bei der Inbetriebnahme eines PMC-Programms geht aus Bild Al.9 
hervor. 

Mit dem Programmsystem zur PMC-Dokumentation können über Lochstreifen und 
Schreibautomat zwei Unterlagen erstellt werden. Das Programm Zustandsgraphen stanzt 
einen Lochstreifen aus, der beim Ausdrucken auf einem Schreibautomaten eine schema¬ 
tische Darstellung der Verknüpfungen des PMC-Programms in Form von Signalzustands¬ 
graphen liefert. 



Dokumenfationsunter/agen 


manuelle 

Vorbereitung 


Inbetriebnahme 


Fixierung und 
Dokumentation 
des PMC-Programms 


Bild Al.9. Schritte bei der Inbetriebnahme eines PMC-Programms 
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Das Programm Cross-Referenz liefert ebenfalls einen Lochstreifen, mit dem eine Cr oss- 
Referenz-Liste aller im PMC-Programm vorkommenden Variablen ausgedruckt werden 
kann. 


Al. 11. Programmierung 

Die Erstellung der Anwenderprogramme für das zu bearbeitende Werkstück (Werkstück¬ 
programmierung) und für die Anpassung der Steuerung an einen bestimmten Werkzeug¬ 
maschinentyp (PMC-Programmierung) hat nach den entsprechenden Programmieranlei¬ 
tungen [8.8] zu erfolgen. Dennoch sollen für das allgemeine Verständnis einige Aspekte 
der Programmierung dargelegt werden. Als Lochstreifencode dient der ISO-7-bit-Kode 
nach TGL 23207/01 bzw. der Kode E/A RS 244. Die Kodeerkennung erfolgt automa¬ 
tisch in der Steuerung anhand des Programmanfangszeichens. Aus den Zeichen eines 
festgelegten Zeichenvorrats werden Wörter definierten Formats gebildet. Der Satzaufbau 
erfolgt gemäß TGL 200-0863/02, die maximale Satzlänge beträgt 96 Zeichen. Viele Sätze 
ergeben ein Programm. Zur besseren Übersichtlichkeit von Programmen kann die Haupt¬ 
satzschreibweise angewendet werden. Einige für die neue Steuerungsgeneration typische 
Programmierfunktionen, die dann auch den Funktionsinhalt der Steuerung charakteri¬ 
sieren und durch das Steuerprogrammsystem realisiert werden, seien nachfolgend ange¬ 
führt. 

Ä quidistan tenberechn ung 

Die Steuerung führt eine vollständige Äquidistantenberechnung aus sowohl für Innen¬ 
ais auch für Außenkonturen. Ebenenangaben sind nicht erforderlich. 

Parameterzuweisung in NC-Programmen und in Unterprogrammen 

NC-Adressen können neben festen Zahlenwerten Parameter zugewiesen werden. Vor 
ihrer Zuweisung müssen sie grundsätzlich definiert werden. 

Rechenvorschriften für Parameter 

Neben der direkten Zahlenzuweisung ist es möglich, Parameter aus Parametern und Zah¬ 
lenwerten zu errechnen. Dabei sind die Rechenvorschriften -f-, —, :, sin, cos zulässig. 

Unterprogrammtechnik 

Unterprogramme (UP) sind für mehrfach nutzbare Programmteile in Werkstückpro¬ 
grammen empfehlenswert. Das UP wird nach Abarbeitung des NC-Satzes ausgeführt, 
der den UP-Aufruf enthält. Unterprogramme können wieder Unterprogrammeaufrufen; 
dabei sind maximal fünf Unterprogrammebenen erlaubt. 

Es wird zwischen allgemeinen technologischen Unterprogrammen (z. B. Bohrzyklen, 
Lochmuster u.a.) und hauptprogrammspezifischen Unterprogrammen (zur Verein¬ 
fachung des Hauptprogramms) unterschieden. Erstere werden im Unterprogramm¬ 
speicher abgelegt und stehen für jedes beliebige NC-Programm zur Verfügung. 

Werkstückspezifische UP werden mit im Werkstückprogrammspeicher abgelegt und 
stehen nur für das dafür vorgesehene Werkstückprogramm zur Verfügung. 

Programmabschnittswiederholung 

Mittels dieser Funktion können im Hauptprogramm und in den Unterprogrammen Pro¬ 
grammschleifen definiert werden. Die Auswahl der Durchläufe einer Schleife wird mit 
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einem zweistelligen Wort gekennzeichnet. Programmabschnittswiederholungen sind in 
maximal fünf Ebenen schachtelbar. Innerhalb von Programmabschnitten können Unter¬ 
programme aufgerufen werden. 

Geometrische Formelelemente 

Mit Hilfe dieser Funktion können Punkte, Geraden und Kreise definiert und durch die 
Steuerung berechnet werden, die im weiteren Programmablauf benötigt werden, jedoch 
nicht aus der Werkstückzeichnung ablesbar sind. Die Funktion „geometrische Formelele¬ 
mente“ stellt somit ein Hilfsmittel dar, das zur Berechnung der verschiedenen geometrischen 
Probleme ohne Zuhilfenahme externer Rechner verwendet wird. Die hauptsächlichen 
Anwendungsgebiete sind die Konturbeschreibung der Werkzeugbahn und Bohrbildbe¬ 
schreibungen. Geometrische Formelelemente können in Form von sog. Rechensätzen 
an beliebiger Stelle im Werkstückprogramm geschrieben werden. Für diese Rechen¬ 
sätze ist ein spezielles Format zu verwenden. Sie definieren (u.U. in mehreren Schritten) 
einen bestimmten Punkt, dessen Koordinaten unter den im Satz geschriebenen Q-Adres¬ 
sen im weiteren Programmablauf anwählbar sind. Im eigentlichen Satz des Teilepro¬ 
gramms wird der jeweiligen Koordinate der vorher im Rechensatz berechnete konkrete 
Zahlenwert zugewiesen. Die durch die Rechensätze angewiesenen Rechnungen werden 
während der Einlesephase ausgeführt, so daß die Rechensätze nicht den Werkstückpro¬ 
grammspeicher belasten. 

Weitere Programmierfunktionen stehen für die Werkzeugwahl und die Autoprogram¬ 
mierung beim Drehen zur Verfügung. 

Die Steuerung erkennt eine Vielzahl von Programmierfehlern, die einzelnen Funktio¬ 
nen zugeordnet sind und in kodierter Form am Bildschirm angezeigt werden. Sie gewähr¬ 
leistet damit in Verbindung mit den komfortablen Programmredigiermöglichkeiten vor 
Ort über Datentafel und Bildschirm eine effektive Inbetriebnahme von Werkstückpro¬ 
grammen. 

PMC-Programmierung 

Die Darstellung in Form von Booleschen Ausdrücken, die aus logischen Verknüpfungen 
von Eingangsvariablen, Ausgangsvariablen, Zwischenspeichern u.ä. bestehen, stellt den 
Kern für die Programmierung der PMC 600 dar. Mittels dieser Booleschen Ausdrücke 
werden logische Wertezuweisungen (Boolesche Gleichungen), bedingte Sprünge, Fehler¬ 
meldungen und Anzeigen notiert. Dieser Teil der Programmierung kann durch Einfügen 
von Assemblerprogrammen universell erweitert werden. Der Logikteil des PMC-Pro- 
gramms wird in problemangepaßter Form unabhängig von dem verwendeten Mikropro¬ 
zessor notiert, die Assemblerprogramme sind im Kode des Mikroprozessors U880 zu 
schreiben. 

Die Erfassung der PMC-Programme erfolgt im ISO-7-bit-Kode oder im EIA-Kode. 
Für das Formulieren der Booleschen Gleichungen ist es dabei gleichgültig, ob die not¬ 
wendigen Informationen aus einem Impulsdiagramm, einem Relaisplan, mittels auto¬ 
matentheoretischer Methoden oder aus einer verbalen Beschreibung der Steuerungs¬ 
aufgabe gewonnen werden. 

Zur Bildung der Booleschen Ausdrücke stehen die Operatoren UND, ODER, NICHT 
sowie öffnende und schließende Klammern zur Verfügung. Innerhalb eines solchen Aus¬ 
drucks können 1 bis 42 Variable verknüpft werden. Mehrfache Klammerung ist zugelas¬ 
sen; das Klammerniveau darf niemals negativ werden. 

Durch eine logische Gleichung wird ein Boolescher Ausdruck einer Variablen zu- 
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geordnet. Als Variable fungieren Eingänge, Ausgänge, Zwischenspeicher, Zeitglied¬ 
eingänge und -ausgänge sowie NC-Befehle. Von den 480 Zwischenspeichern der PMC 600 
sind 300 für die Anwenderlogik frei verfügbar. 

Jede Boolesche Gleichung beginnt mit einer Satznummer, die eine Bezugnahme auf die 
Gleichung bei bedingten Sprüngen bzw. beim PMC-Dialog ermöglicht. Ein bedingter 
Sprung wird z.B. in der Form geschrieben: 

Nxxx : Nyyy = Boolescher Ausdruck 

Dabei ist Nxxx die laufende Satznummer. Ist der Boolesche Ausdruck wahr, wird das 
Programm bei Nyyy fortgesetzt; ist er nicht wahr, erfolgt die Fortsetzung bei dem auf 
Nxxx folgenden Satz. Sprünge werden vor allem benutzt, um die Abarbeitung der Steuer¬ 
logik zu beschleunigen. 

Eine wichtige Sonderfunktion, die im Rahmen der PMC-Programmierung zur Ver¬ 
fügung gestellt wird, ist die Anzeigemöglichkeit von bis zu 199 Maschinenfehlern in fol¬ 
gender Art: 

Nxxx : Fnnn = Boolescher Ausdruck 

Ist der Boolesche Ausdruck wahr (in ihm kann der Anwender bestimmte Maschinen¬ 
zustände verknüpfen), so wird Fnnn am Bildschirm der CNC 600 angezeigt. Liegt der 
Zustand „falsch“ vor, so erfolgt keine Anzeige. 

Eine weitere programmierbare Funktion sind die sog. Anzeigebits, mit denen wichtige 
Zustände zur Anzeige am CNC-Bildschirm gebracht werden können. Zu diesem Zweck 
sind 16 Zwischenspeicher Z reserviert. Die Programmierung erfolgt in der Form 

Nxxx : Zyy = Boolescher Ausdruck 

Eine Anzeige erfolgt, wenn der Boolesche Ausdruck wahr ist. 

Zur Realisierung von Funktionen, die sich in Boolescher Algebra nur umständlich aus- 
drücken lassen, können in die Logik Programme im U880-Kode (Assemblerprogramme) 
eingefügt werden: 

Nxxx : B = (Programm im U880-Kode) 

Die Assemblerprogramme können auf alle Variablen zugreifen und somit z. B. auch Zwi¬ 
schenspeicher beeinflussen, die in Booleschen Gleichungen weiterverarbeitet werden. 
Bereits im Betriebssystem der PMC 600 sind die Assemblerprogramme 

- Zeitgliedroutine, 

- Hauptantriebssteuerung, 

- Positionierroutine für Werkzeugwechsel 

enthalten. 

Die Zeitgliedroutine behandelt 32 Zeitglieder. Zeitglieder können programmiert wer¬ 
den in Schritten von 0,1 s von 0 bis 99 min 59,9 s. 

Das Programm Hauptantriebssteuerung hat als Hauptaufgaben die Bestimmung der 
Getriebestufe, der Sollwertspannung für den D/A-Wandler, das Einarbeiten des Override 
sowie die Freigabe der Sollwertspannung unter Berücksichtigung der Drehrichtung. Die 
Positionierroutine für Werkzeugwechsel erfüllt für einen inkremental arbeitenden Werk¬ 
zeugspeicher die Funktionen Referenzpunktanfahren, Ordnung der Speicherbestückung, 
Speicherpositionierung auf Sollwert und Ablaufüberwachung. 
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Al. 12. Freiprogrammierbare Steuerungfür automatische Fertigungszellen CNC 603 

Flexible Fertigungszellen werden bei der weiteren Rationalisierung der spanenden Ferti¬ 
gung von Klein- und Mittelserien eingesetzt. Sie sind dadurch gekennzeichnet, daß ein 
meist mehrere Bearbeitungsarten erforderndes Teilespektrum weitestgehend automati¬ 
siert im bedienerarmen bzw. bedienerlosen Betrieb gefertigt wird. 

Zur Steuerung derartiger Fertigungszellen für den technologischen Prozeß Bohren/ 
Fräsen wurde die Steuerung CNC 603 entwickelt, die gegenüber der üblichen CNC 600 
eine Reihe wesentlicher Funktionserweiterungen enthält. Dazu gehören insbesondere: 

- Automatikbetrieb für bedienerarmen bzw. bedienerlosen Betrieb, 

- Werkstückkontrolle, 

- Werkzeugkontrolle, 

- elektronisches Gewindeschneiden und Spindelrichten, 

- erweiterter Funktionsinhalt bei der NC-Programmierung, 

- Prozeßdatenerfassung, 

- wegabhängige Schmierung, 

- analoge Meßwerteingabe in die PMC (über PEAS). 

Die Erweiterungen im Automatikbetrieb beziehen sich auf die Listenführung bei vor¬ 
handenem Werkstückspeicher (Zuordnung Werkstückprogramm-Palettennummer) und 
auf die zwei realisierten Betriebsarten für die Auswahl des zu bearbeitenden Werkstücks. 
In der ersten Betriebsart erfolgt der Palettenaufruf durch das PMC-Programm, und das 
zugehörige Werkstückprogramm wird automatisch gestartet. 

In der zweiten kann die Programmreihenfolge vorgegeben werden, und es erfolgt auto¬ 
matisch das Einwechseln der entsprechenden Palette. 

Für die Werkstückkontrolle dient ein 3-D-Meßtaster zur Erfassung der Werkstück¬ 
konturen in Richtung der translatorischen Achsen. Die ermittelten Meßwerte werden als 
Parameter (im erweiterten Parameterspeicher) achszugeordnet gespeichert und im NC- 
Programm verrechnet. Auf diese Weise kann sowohl das automatische Einrichten ein¬ 
gewechselter Werkstücke als auch die Kontrolle der Maßhaltigkeit eines Werkstücks 
während bzw. nach der Bearbeitung erfolgen. Mittels eines Kalibertasters kann die Kon¬ 
trolle von Bohrungen auf Maßhaltigkeit erfolgen. Sowohl 3-D- als auch Kalibertaster 
werden von der Steuerung wie ein Werkzeug im Werkzeugmagazin behandelt; ihre Maß¬ 
werte werden telemetrisch zur Steuerung übertragen. 

Die Werkzeugkontrolle umfaßt die Standzeitüberwachung der Werkzeuge, die optische 
Erfassung von Werkzeugbruch mittels einer Fernsehkamera sowie die Möglichkeit einer 
automatischen Fortsetzung der Bearbeitung bei gebrochenem bzw. verschlissenem Werk¬ 
zeug mit Ersatzwerkzeugen. 

Das elektronische Gewindeschneiden und Spindelrichten erfolgt durch Ausrüstung der 
Hauptspindel mit einem Meßsystem. Die Hauptspindel wird so als fünfte NC-Achse lage¬ 
geregelt. 

Zum erweiterten Funktionsinhalt bei der NC-Programmierung sind insbesondere zu 
rechnen: 

- 6 Festwerte je Achse, 

- 200 Parameterspeicherplätze, 

- erweiterte Rechenmöglichkeiten (y/, tan, arctan, arcsin), 

- vereinfachte Verarbeitung negativer Parameter, 

- Korrektur der Festwerte und Werkzeugkorrekturwerte durch NC-Programme (z.B. 
Meßroutinen). 
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Im Rahmen der Prozeßdatenerfassung wird ein Protokoll der Maschinenauslastung er¬ 
stellt, das z.B. Uhrzeit (mit Echtzeituhr realisiert), Stückzeit, Einsatzzeit, bearbeitete 
Werkstücke je Programm usw. enthält. 

Zur Realisierung der wegabhängigen Schmierung werden die verfahrenen Wege je 
Achse erfaßt, und bei Erreichen der für die Schmierung generierten Wegspanne wird über 
PMC/PEAS ein entsprechender Schmierimpuls ausgegeben. 

Die in der PMC/PEAS realisierte analoge Meßwerteingabe kann zur Erfassung kriti¬ 
scher Maschinenzustände im Rahmen einer Maschinendiagnose genutzt werden (z.B. 
Erfassung von Lagertemperaturen, Ständerverzerrungen u.a.). Es stehen acht analoge 
multiplexe Eingangskanäle einer Wandlungsbreite von 8 bit zur Verfügung. 

Für die Realisierung der erläuterten Zusatzaufgaben werden, ausgehend von der 
CNC601 - Ausbaustufe für fünf Achsen und 32 KByte Werkstückprogrammspeicher 
folgende Zusatzbaugruppen benötigt: 

- Erweiterung des Speicherausbaus im Leitrechner um 4 KByte CMOS-RAM, 16 KByte 
EPROM und 32 KByte DRAM für Werkstückprogrammerweiterung mit den Spei¬ 
chermoduln K3521, K3820 und K3525 unter Ausnutzung der bereits vorbereiteten Spei¬ 
chererweiterung; 

- Steckeinheit „schneller“ Eingang zur Erfassung und Bereitstellung des Meßtaster¬ 
signals, die am Wegesteuerungsbus arbeitet; 

- Steckeinheit Werkzeugbrucherkennung, die von der Fernsehkamera kommende Signale 
auswertet und am PEAS-Bus arbeitet; 

- Steckeinheit zur A/D-Wandlung für acht multiplex aufrufbare Kanäle mit einer Wand¬ 
lungsbreite von 8 bit (Eingangsspannungsbereich —5 bis -1-5 V, Wandlungszeit 40 fis), 
diese Steckeinheit arbeitet am PEAS-Bus; 

- Steckemheit, die gestattet, vier analoge Widerstandsmeßwandler anzuschließen und die 
die Anpassung an die genannte Steckeinheit zur A/D-Wandlung durchführt. 


A2. Gerätesystem ursalog 5000 

Das Gerätesystem ursalog 5000 umfaßt die speicherprogrammierbaren Steuereinrichtun¬ 
gen (SPS) ursalog 5010 und ursalog 5020. Die SPS ursalog 5000 werden für die Steuerung 
von Be- und Verarbeitungsmaschinen und Kinematiken der Roboter- und Handhabe¬ 
technik eingesetzt. 

Die anwendungsrelevanten Parameter und Merkmale beider SPS sind in Tafel Al dar¬ 
gestellt. Während die ursalog 5010 eine SPS der unteren Leistungsklasse darstellt, erlaubt 
die ursalog 5020 eine Anpassung an komplexe Steuerungsprobleme mittleren bis großen 
Umfangs. 

Die SPS ursalog 5000 realisieren zyklisch die Funktionen 

- Erfassung und Speicherung der Eingangssignale, 

- Realisierung des zur Beschreibung des Steueralgorithmus erarbeiteten Anwenderpro¬ 
gramms, 

- Ausgabe der Ausgabesignale. 

Die Anwendungsgrenzen der SPS ursatron 5000 werden technisch bestimmt durch die 

- maximale Zahl und Art der Eingangs- und Ausgangssignale, 

- für dieAufnahme des Anwenderprogrammszur Verfügung stehenden Speicherkapazität, 

- realisierbare minimale, durch die Verarbeitungszeit bedingte Reaktionszeit, 

- Einsatzbedingungen. 
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Tafel Al. Parameter und Merkmale der SPS ursalog 5010 



SPS ursalog 5010 

SPS ursalog 5020 

Zentraleinheit 

kompakte Verarbeitungs- 

modulare Verarbeitungseinheit 2 (VE 2) 


einheit 1 (VE 1) 


CPU 

U880 

MRS Kl 520 (U880) 

Prozeßsignal- 

Baugruppensystem 

modulare Baugruppen des ursadat5000 

E/A-Anpassung 

ursalog 4000 

in Robustperipherie ursalog 5020 

Anzahl binärer 



E-Signale 

32 

) ) 

A-Signale 

16 

1 > 2048, 256 bei Robustperipherie 

Merker 

255 

j ) davon 

Zeit/Zählglieder 

16 

) 1 Byte je Zeit/Zählglied 

Analoge E/A 

nein 

ja 

Programmsprache 

PROLOG 1 

PROLOG 2 

Programmierung 



ausgehend von 

Logikplan, Schaltgleichungen, PAP, PAG 

Programmiertechnik 

Programmiergerät ursatron 5000 

Programminbetriebnahme 

PROTES 5011 

PROTES 5020, LOTES 5020 

Inkrementelle Weg/Winkel- 



geber 

nein 

ja 


Für die Programmerarbeitung, ausgehend von den üblichen Formulierungen des 
steuerungstechnischen Verhaltens der Einrichtung, dem Logikplan, den Schaltgleichun¬ 
gen, dem Programmablaufplan oder dem Programmablaufgraphen, wurde die Fach¬ 
sprache PROLOG entwickelt, PROLOG 2 für die SPS ursalog 5020 und als Untermenge 
PROLOG 1 für die SPS ursalog 5010. 

Die Programmerarbeitung für die SPS ursalog 5000 erfolgt auf dem Programmiergerät 
ursatron 5000 (PG ursatron 5000). Es realisiert die Umsetzung des in PROLOG formu¬ 
lierten Anwenderprogramms (AP) in das Objektprogramm (OP) in Maschinensprache. 
Dabei kommen die Compiler PROLOG 5010 und PROLOG 5020 zur Anwendung. 

Das Programmiergerät ermöglicht in Kopplung mit den SPS auch die Inbetriebnahme 
und den Test des AP. Die Kopplung erfolgt über das serielle, sternförmige Interface 
IFSS gemäß TGL 29331. Dazu wurden die Softwarepakete PROTES 5011 und PROTES 
5020 geschaffen. Sie gewährleisten in Verbindung mit dem PG ursatron 5000 eine vielfäl¬ 
tige Beeinflussung der Abarbeitung des Anwenderprogramms und die schrittweise und 
segmentweise Kontrolle der Abarbeitung. 


A2.1. Speicherprogrammierbare Steuereinrichtung ursalog 5010 

Die SPS ursalog 5010 ist als robuste Steuereinrichtung für die Steuerung von Maschinen 
und Kinematiken der Handhabetechnik mit binären Signalgebern und binären Stellglie¬ 
dern ausgelegt worden. Sie umfaßt die kompakte Verarbeitungseinheit 1 (VE 1) zur Rea¬ 
lisierung der Steuerfunktionen sowie Baugruppen und Stromversorgungseinrichtungen 
des Baugruppensystems ursalog 4000 zur Realisierung der Prozeßsignalanpassung und 
der Stromversorgung. 
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Verarbeitungseinheit 1 

Der Aufbau der VE 1 wird im Bild A2.1 in Blockdarstellung gezeigt. 

Der interne funktionelle Ablauf sowie die Steuerfunktionen werden mit Hilfe der CPU 
(U880) und dem Zähler/Zeitgeber (U857) realisiert. Dazu erfolgt die Speicherung des 
Betriebssystems (LOGOS 5010) und von Unterprogrammen (1 KByte) sowie des OP 
(2 KByte) auf EPROM (U555). Zur Speicherung der binären Eingangsvariablen und 
Ausgangsvariablen sowie der bei der Lösung der Steuerfunktionen notwendigen operati¬ 
ven Variablen dient der RAM (U2, B2, 1 KByte). 





Bild A 2.1 

Verarbeitungseinheit 1 ( VE 1) 


Die binären Eingangssignale werden über die Eingangsfilter und Signalumschalter 
byteweise in den RAM übertragen. Die binären Ausgangssignale werden ebenfalls byte¬ 
weise aus dem RAM gelesen und in die Ausgabespeicher übertragen. 

Für die Impulsfrequenzmessung (/ ^ 5 kHz) oder die äquivalente Zeitmessung und die 
im Ergebnis der Meßvorgänge auszugebenden Entscheidungssignale wurden zusätzlich 
Eingänge und Ausgänge geschaffen. Signalanpassungsschaltungen realisieren die Filte¬ 
rung und Pegelanpassung sowie die zeitlich begrenzte Speicherung der Ausgabesignale. 

Mit Hilfe der Schaltungsanordnung für die RESET-Erzeugung erfolgt die Initialisie¬ 
rung des Startzustands bei Netzeinschaltung sowie von Hand über eine Löschtaste. 

Der fehlerfreie Lauf der VE 1 wird durch PROM-Test, RAM-Test, SV-Überwachung 
und Programmlaufzeitüberwachung umfangreich überwacht und gemeldet. 

Die VE 1 wird übereinstimmend mit dem Baugruppensystem ursalog 4000 mit 
.24 V ± 25 % gespeist. Eine eigene Schaltungsanordnung gewährleistet die Erzeugung der 
erforderlichen internen, höherstabilisierten Speisespannungen. 

Das Betriebssystem der VE 1 (LOGOS 5010) umfaßt die Programmteile für die Initia¬ 
lisierung der VE 1, die Übertragung der Eingangsvariablen in den RAM, der Ausgangs¬ 
variablen in die Ausgabespeicher sowie für die Steuerung der Abarbeitung des OP ein¬ 
schließlich des Einsatzes der Unterprogramme sowie des Ablaufs der Diagnoseprogramme 
und Testprogramme. Das OP für die Realisierung von Schaltgleichungen wird direkt 
durch den Mikroprozessor abgearbeitet; für die Realisierung der Zeit- und Zählfunktionen 
werden Unterprogramme aufgerufen. 

In Ergänzung der VE 1 wurde für die Inbetriebnahme die Inbetriebnahmebaugruppe 
(VE II) entwickelt, die zur effektiven Inbetriebnahme des AP in Kopplung mit dem Pro¬ 
grammiergerät ursatron 5000 dient. Sie ist anschlußkompatibel zur VE 1. 

Für die Inbetriebnahme des Anwenderprogramms wurde die Testsoftware PRO- 
TES 5011 entwickelt. Sie gewährleistet in Verbindung mit dem Programmiergerät 
ursatron 5000 eine vielfältige Beeinflussung der Abarbeitung des Anwenderprogramms und 
die schrittweise und segmentweise Kontrolle der Abarbeitung. 
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Prozeßsignalanpassung 

Die Prozeßsignalanpassung gewährleistet die Anpassung der Prozeßsignale an die Ein¬ 
gangssignale und Ausgangssignale der VE 1 und umfaßt die Pegelanpassung, galvanische 
Trennung, Verzögerung, Entprellung, Verstärkung, Speicherung und Anzeige von Signa¬ 
len. Sie wird mit Hilfe von Baugruppen des Baugruppensystems ursalog 4000 realisiert, 
die auch eine der VE 1 vor- und nachgeschaltete Signal Verknüpfung ermöglichen. Die 
Baugruppen besitzen eine ausgangsseitige Kurzschlußfestigkeit und eine hohe Stör- und 
Zerstörfestigkeit der Ein- und Ausgänge. Sie gewährleisten den Einsatz der SPS ursalog 
5010 unter rauhen Industriebedingungen. 


A2.2. Speicherprogrammierbare Steuereinrichtung ursalog 5020 

Die SPS ursalog 5020 ist als modulare Steuereinrichtung für die komplexe Steuerung von 
Maschinen und Kinematiken der Robotertechnik ausgelegt worden. Sie gestattet die 
Lösung aller üblichen Steuerfunktionen binärer Steuerungen sowie arithmetischer Funk¬ 
tionen und die dazu erforderliche Erfassung und Ausgabe binärer, digitaler und analoger 
Signale. Die externe Parametrierung d.h. die Änderung der Sollwerte von Zeit- und Zähl¬ 
gliedern sowie die Änderung des Steueralgorithmus in Abhängigkeit von Prozeßsignal¬ 
werten und Bedieneingaben sind möglich. Die SPS ursalog 5020 umfaßt die modulare 
Verarbeitungseinheit (VE 2), Baugruppen zur Prozeßsignalerfassung und Ergänzungs¬ 
baugruppen sowie die zugehörigen Stromversorgungseinrichtungen. 

Der Aufbau der SPS ursalog 5020 wird im Bild A2.2 in Blockdarstellung gezeigt. 


Betriebssysfem Objekt- operative Zähler, 

Unter- Programm Daten Zeitgeber 

Programm 



extern ZAOIZAOZ 

Bild A2.2. Aufbau der SPS ursalog 5020 

Verarbeitungseinheit 2 

Die VE 2 ist aus Baugruppen des Mikrorechnersystems Kl 520 und SPS-spezifischen Bau¬ 
gruppen aufgebaut. Sie erfüllen die Busrichtlinie TGL 37271 (K1520-Bus). 
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Als Baugruppen des MRS Kl 520 werden folgende Baugruppen in der VE 2 projekt¬ 
abhängig eingesetzt: 

ZRE K2521.05 zentrale Recheneinheit mit LPU; 1 KByte statischer RAM, 3 KByte 
EPROM, 1 PIU, 1 LTL; 

OPS K3520.05 4 KByte statischer RAM; 

OPS K3521.05 4 KByte statischer RAM, CMOS, batteriegestützt; 

OFS K3620.05 2 KByte statischer RAM, 6 KByte EPROM; 

PFS K3620.05 16 KByte EPROM. 

Die EPROM dienen zur Aufnahme des Betriebssystems und des OP, die RAM als 
Operativspeicher. 

Die Initialisierung erfolgt bei Zuschalten der Netzspannung. Soll der erreichte Steuer¬ 
zustand nach Ausfall der Netzspannung erhalten bleiben, so ist für die Speicherung der 
Eingabevariablen, Ausgabevariablen und Merkervariablen ein gestützter CMOS-RAM 
einzusetzen. 

Als problemorientierte Baugruppe der VE 2 wurde die BG Kontrollmodul (KOMO, 
3705) entwickelt, der den Anschluß eines Tastatur-Anzeige-Vorsatzes (TAV, 3726) er¬ 
laubt. 

Im einzelnen werden folgende Überwachungsfunktionen realisiert: 

- Überwachung der Abarbeitung der Programme des Betriebssystems, des Anwender¬ 
programms sowie von Dienstprogrammen durch Analyse der vom Betriebssystem er¬ 
zeugten Fehlerbytes; 

- Überwachung der von den SV-Einrichtungen abgegebenen Meldesignale und Bildung 
von Steuersignalen für die Steuerung des Prozessors der ZRE zum Autostart oder 
Start einer Netzausfallroutine; 

- Festlegen der Betriebsart der SPS ursalog 5020. 

Es sind dies 

LAUF Abarbeitung des Anwenderprogramms; 

TEST Aktivierung der Schnittstelle IFSS bei Anschluß des Programmiergeräts 
(durch PROTES beeinflußter Lauf des AP); 

HAND Arbeit mit LOTES; 

RETT Initialisierung des Laufs eines Anwenderprogramms (wird gewählt nach er¬ 
kanntem Fehler im Prozeß). 

Der KOMO ist ein problemorientierter Einkartenmikrorechner (CPU, 1 KByte 
PROM, CTC, PTO, 1 KByte RAM). Der TAV kann direkt auf die Baugruppe KOMO 
gesteckt werden oder über ein 1,5-m-Adapterkabel angeschlossen werden. Es erlaubt den 
Anschluß eines Kassettenmagnetbandgeräts als Massenspeicher. 

Der TAV trägt den 

- Betriebsartenschalter; 

- acht 7-Segment-Anzeigeelemente; 

- zwei Luminiszenzdioden (Ix für Spannungskontrolle, 1 x für Pegelkontrolle bei Kas¬ 
settenmagnetbandeingabe) ; 

- 21stellige Textatur (hexadezimal + Sonderzeichen). 

Die Überwachung der Programme erfolgt durch Überwachung des zeitlichen Abstands 
der von der ZRE generierten Fehlerbyte (^26 ms); erkannte Fehler werden auf dem TAV 
angezeigt. 
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Ein-/Ausgabe-Baugruppen 

Die Ein-/Ausgabe-Baugruppen (E/A-BG) gewährleisten die Kopplung der SPS mit dem 
Prozeß. 

Es bestehen zwei gerätetechnische Lösungen: zum einen die Verwendung von E/A-BG, 
die direkt am K1520-Bus arbeiten und denen ggf. Baugruppen des BG-Systems ursa- 
log 4000 vor- oder nachgeschaltet werden, und zum anderen die Verwendung der E/A-BG 
der Robustperipherie ursalog 5020. 

£/A-Baugruppen mit K1520-Bus 

Die Tafel A2 enthält eine Auswahl der in SPS ursalog 5020 häufig angewendeten E/A-BG 
mit K1520-BUS. Sie erlauben die Eingabe und Ausgabe analoger und digitaler Signale. 

Für den Anschluß inkrementeller Geber wurde eine Mikrorechnerbaugruppe (UM) 
entwickelt, die von der ZRE wie eine E/A-BG behandelt wird. Sie übernimmt Sollwerte 
der Wege oder Winkel und erfaßt die von den Gebern abgegebenen Impulsfolgen. Bei Er¬ 
reichen der vorgegebenen Sollwerte wird anwendungsabhängig ein Interruptsignal ge¬ 
geben oder eine vereinbarte Marke in den RAM abgelegt, die von der ZRE gelesen werden 
kann [8.30]. 


Tafel A2. EjA-Baugruppen mit K1520-Bus 


Typ Kurzcharakteristik 


DES 2340 
DEM 2341 

DES-KT 2344 

DA-R 2331 
DAS-KT 2334 

DA-0 2335 

DA-T 2336 
SE-AS 2351 
AE-G 2310 


AA-1K2301 
UM 3760 


Digitaleingabe statisch, 16 Bit, optoelektronische Trennung, Pegel: 5,12, 24, (60) V Gs 

Digitaleingabe multiplex, Matrixabfrage von 128 Bit Kontaktsignalen, optoelektroni¬ 
sche Trennung 

Digitaleingabe statisch mit Systempegel ursalog 4000 32 Bit, geeignet zur Eingabe von 
Signalen, die von der BG ursalog 4000 abgegeben werden 

Digitalausgabe mit Relais RGK 20/1, 24 bit, max. 60 V Gs/Ws/0,5 A/10 W 

Digitalausgabe statisch mit Systempegel ursalog 4000 32 Bit, geeignet zur Ausgabe von 
Signalen an BG ursalog 4000 

Digitalausgabe mit Optokoppler, 16 Bit, optoelektronische Trennung, Transistor¬ 
ausgang max. 60 V Gs/0,1 A/3 W 

Digitalausgabe mit Transistor, 32 Bit, max. 60 V Gs/0,12 A/7,2 W 
Service-Einheit-Anschlußsteuerung 

Analogsignaleingabe, 8 Kanäle multiplex, Analogsignal: 1 V, Digitalisierung: 12 Bit 
dual, Umsetzungszeit: 25 (i.s, Fehlerklasse: 0,25; 0,4; 0,6 geberabhängig. 

Weitere Baugruppen realisieren: Signalverstärkung, Erhöhung der Kanalzahl, galva¬ 
nische Trennung, Anpassung passiver Geber u.a. 

Analogsignalausgabe.1 Kanal, Digitalsignal: 10 Bit dual, Analogsignal: 10 V; 5 mA; 
1-5 mA; 20 mA; 4-20 mA; Fehlerklasse: 0,1; Umsetzungszeit: 200 [xs 

Inkrementsignalfolgeeingabe für 3 inkrementeile Geber IGR oder IDL 500 des VEB 
Carl Zeiss JENA. 


£/A-Baugnippen der Robustperipherie 

Die Robustperipherie erlaubt den Aufbau einer selbständig arbeitenden E/A-Signal- 
Anpassungseinheit. Sie besteht aus einer Mikrorechner-BG, der Robustbussteuereinheit 
(R-Bus-S, 3725), die am K1520-Bus der VE 2 arbeitet und den Robustbus (R-Bus) ge- 
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neriert. Die E/A-BG der E/A-Signal-Anpassungseinheit können bis zu 200 m von der 
R-Bus-S abgesetzt angeordnet werden. Der R-Bus und die Prozeßsignaleingänge und 
-ausgänge besitzen eine hohe Stör- und Zerstörfestigkeit. Der R-Bus und die Prozeß 
signalausgänge sind kurzschlußfest. 

Tafel A3. EjA-Baugruppen der Robustperipherie ursalog 


Typ Kurzcharakteristik 


R-BUS-S 3725 

R-BUS-A 3721 

R-BUS-TR 3720 
R-DES-KT 3730 
R-DES-K 3731 
R-DES-I 3732 
R-DAS-3A 3741 
R-DAS-TC 3742 

R-DAS-RI 3743 
R-DAS-RU 3744 
R-DAS-0,25 3745 


Robust-BUS-Steuerung, generiert aus dem K1520-BUS den Robust-BUS am 
Frontstecker, Diagnose-Funktionen 

Robust-BUS-Anschluß, führt den Robust-BUS vom Frontstecker auf die Rück¬ 
verdrahtung 

Robust-BUS-Treiber, wie R-BUS-A, jedoch mit Signalregenerierung 
Digitaleingabe statisch mit Systempegel ursalog 4000, 32 Bit 
Kontakteingabe statisch, 24 V, Kontaktbelastung 10 mA, 32 Bit 
Eingabe von Signalen von Initiatoren des VFB MGB, 24 Bit 
Schaltverstärker 24 V ±25 %/3A, Gs, 6 Bit 

Schaltverstärker mit Triac 220 V Ws + 10% — 15%/3 A, 4 Bit, Schmelzsicherung 
je Ausgang mit Sicherungsanzeige 

Relais-Ausgabe über GBR 10, 8 Bit (Wechsler), max. 30 V, 0,1-3 A 

wie R-DES-RI, jedoch 220 V Ws/150 VA/cos ?> = 1, 220 V Ws/100 VS/ cos (p = 0,4 

Schaltverstärker 24 V ± 25 %I0,25 A, 14 Bit 



Bild A2.3. Kopplung des K1520-Bus mit dem R-Bus 


Tafel A3 enthält die Baugruppen der Robustperipherie. Die BG der Robustperipherie 
haben für alle E/A-Signale eine Statusanzeige und werden aus einer unstabilisierten 
Stromversorgung gespeist. Die Robustperipherie erlaubt eine umfangreiche Eigendiagnose 
und die Erkennung von Kurzschlüssen der Ausgabestromkreise. 
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Die R-Bus-S gewährleistet eine von der VE 2 unabhängige Arbeitsweise. Das Erfas- 
sungs-, Ausgabe- und Diagnoseprogramm ist PROM-resident. Die E-Signal-Zustände 
werden zyklisch erfaßt und in einem RAM-Bereich abgelegt und die A-Signale zyklisch 
aus einem RAM-Bereich gelesen und ausgegeben. Die Ergebnisse der Eigendiagnose wer¬ 
den in einem weiteren RAM-Bereich abgelegt. Diese RAM-Bereiche werden von der VE 2 
gelesen bzw. beschrieben. 

Das Interface R-Bus wird mit Hilfe spezieller Bustreiber (D 412) realisiert. Die Daten¬ 
übertragung erfolgt getrennt über jeweils acht Leitungen für die Dateneingabe und -aus- 
gabe. Die Adresse wird über 16 Leitungen (Blockadresse, Moduladresse, Subadresse) 
übertragen; es werden vier Steuerleitungen angewendet. Die Moduladresse wird durch 
die gedruckte R-Bus-Verdrahtung festgelegt; eine Adreßfestlegung auf der BG ist nicht 
erforderlich. 

Bild A2.3 zeigt in Blockdarstellung die Kopplung des K1520-Bus und des R-Bus. 

A2.3. Programmsystem der speicherprogrammierbaren Steuereinrichtung 
ursalog 5020 

Um den Anforderungen mittelgroßer bis großer Steuerungsprobleme und auch der Steue¬ 
rung von Industrierobotern gerecht zu werden, ist die SPS ursalog 5020 serienmäßig mit 
einem Echtzeitsteuerprogrammsystem für Mehrprogrammbetrieb (Multitask-Echtzeit- 
Betriebssystem) ausgestattet. Das Programmsystem PVE2 enthält alle Programme, die in 
einer SPS ursalog 5020 laufen sollen. Das sind die anwendungsunabhängigen Echtzeit¬ 
betriebsprogramme EIEX 1521 und LOGOS 5020 einschließlich spezieller Dienstpro¬ 
gramme, das Testsystem LOTES 5020 sowie die Anwendersteuerprogramme LOGAN 
5020. 

EIEX 1521 ist eine speziell generierte Version des internspeicherorientierten Echtzeit¬ 
steuerprogrammsystems EIEXK1521 und fungiert als Rahmensteuerprogrammsystem 
mit den wesentlichen Funktionskomponenten: 

- Anlauforganisation 

- Interruptorganisation 

- Vorrangorganisation 

- Zeitorganisation 

- Ruforganisation 

- Ein-/Ausgabe-Organisation der Prozeßperipherie. 

Die Programme LOGAN 5020, LOTES 5020 sowie einige Programme von LO¬ 
GOS 5020 laufen unter der Regie von EIEX 1521 im Sinne von Anwendertasks. Eine 
Task ist ein lauffähiges Objektprogramm mit eigenem Stackbereich und definiertem Ein¬ 
sprungspunkt. Die Tasks sind gegeneinander priorisiert und können zyklisch oder durch 
Interrupt oder von anderen Tasks gestartet werden. Die Priorität einer Task, ausgedrückt 
durch eine Zahl < 128, ist gleichzeitig ihr Identifikator. Die höchste Priorität besitzt die 
Task 1. 

LOGAN 5020 ist der Sammelbegriff für die in der SPS laufenden Anwendersteuerpro¬ 
gramme (AP), die gewöhnlich vom Anwender in der Fachsprache PROLOG 2 notiert 
und mit dem Programmiergerät ursatron 5000 übersetzt werden. Der Anwender kann mit 
der Standardversion des PVE2 bis zu sechs Programme (Tasks) mit unterschiedlicher 
Priorität und ggf. Zykluszeit ins Programmsystem aufnehmen. Die Zuordnung von Prio¬ 
rität und Zykluszeit erfolgt in der Programmnotation und muß unter Berücksichtigung 
der bereits im System enthaltenen Tasks vorgenommen werden. Darüber hinaus können 



Tafel A4. Task-Übersicht 


TASK- 

Nr. 

TASK- 

Name 

System¬ 

name 

Zyklus¬ 

zeit 

Laufzeit 


1 


LOGOS 




2 

FAUS 

LOGOS 



Fehlerausgabe 

Systemnachrichten EIEX/LOGOS 

3') 

FEBE 

LOGAN 



Fehlerbehandlung 

kann Anwender schreiben (APRO/E 3) 

4‘) 

INIT 

LOGAN 



Initialisierung 

kann Anwender schreiben (APRO/E 4) 

5 

ANME 

LOGOS 

1 s 


Programm-Anmeldung und 

BAS-Abfrage auf „RETT“ 

6^) 

RETT 

LOGAN 


max.3,5ms 

Rettungsprogramm bei BAS-„RETT“ 
kann Anwender schreiben (APRO/E 6) 

7 

ZYKL 

LOGOS 



Zyklusü ber wach un g/-an zeige 

80 

IMES 

LOGOS 

20 ms 


Erfassungsprogramm 

Inkrementelles Meßsystem 

9 

BLSl 

LOGOS 



Bedienung Langsame Serielle 

Schnittstelle 1 Slave) 

lOO 

BLS2 

LOGOS 



Bedienung Langsame Serielle 

Schnittstelle 2 (Slave) 

11 

TESH 

LOTES 



Testsystem - HAND 

120 


LOGAN 



APRO 12 oder APRE 12 

130 

EMTA 

LOGOS 



DUE-Empfangstask 



LOGAN 



APRO 13 oder APRE 13 

140 

ROBU 

LOGOS 

50 ms 


Robustperipherie-Erfassungsprogramm 



LOGAN 



APRO 14 oder APRE 14 

150 

SGMT 

LOGOS 

50 ms 


SGM-Task 



LOGAN 



APRO 15 oder APRE 15 

160 


LOGAN 



APRO 16 oder APRE 16 

170 


LOGAN 



APRO 17 oder APRE 17 







n-2 

TESL 

LOTES 

100 ms 


Testsystem - LAUF 

n— 1 

TROM 

LOGOS 

10 s 

15 ms/KByte 

Test-/Prüfprogramm PROM 

n 

TRAM 

LOGOS 

10s 

165 ms/KByte 

Test-/Prüfprogramm RAM 


Die Übernahme bzw. Auswahl der Task für das Programmsystem ist optional und wird bei der Generierung des Betriebs¬ 
systems festgelegt. 































































































324 Anhang 

wahlweise je ein Programm zur anwendungsspezifischen Netzausfallrettung, Fehler¬ 
behandlung, Initialisierung und zum Übergang in einen sicheren Prozeßzustand (ausge¬ 
löst durch BAS = RETT) ins PVE2 aufgenommen werden. 

Die Programme des Testsystems LOTES 5020 realisieren Bedien-, Test- und Inbetrieb¬ 
nahmefunktionen, die mittels TAV des Kontrollmoduls oder vom angeschlossenen Pro¬ 
grammiergerät ausgelöst werden. 

Der Anwender hat die Möglichkeit, beim Hersteller der SPS aus einer Menge von 
Standardversionen des PVE2 die für ihn optimale Version auszuwählen. Er kann sich 
aber auch eine auf seinen Anwendungsfall speziell zugeschnittene Version generieren las¬ 
sen. Einige der wesentlichen Angaben für die Generierung, die auch entscheidend den 
Umfang der Betriebssystemkomponenten bestimmen, sind 

- Benutzung der zweiten langsamen seriellen Schnittstelle, 

- Anzahl der aufzunehmenden Anwendersteuerprogramme, 

- Typen und Anzahl von Geräten der Prozeßperipherie, 

- Typen von Sprachmodulen entsprechend dem verwendeten Sprachumfang von PRO¬ 
LOG 2, 

- Typen von Modulen des Testsystems LOTES 5020. 

In Tafel A4 sind die Tasks eines PVE2 für ein Anwendungsbeispiel der SPS ursa- 
log 5020 zusammengestellt. 

A2.4. Fachsprache PROLOG 2 

Zur problemorientierten Notation von Steuerprogrammen wurde die Fachsprache PRO¬ 
LOG 2 entwickelt [8.34]. Sie ist aufwärtskompatibel zur Fachsprache PN 5000 für die 
neue Anlagengeneration NAG [8.35]. Bei der Konzipierung wurde von den Notwendig¬ 
keiten der Anwendung für die SPS ursalog 5020 ausgegangen. Trotzdem weisen die in 
PROLOG 2 notierten Anwendersteuerprogramme (Quellprogramme) kaum maschinen¬ 
spezifische Besonderheiten auf. Sie können in Verbindung mit einem maschinenspezi¬ 
fischen Compiler als Quellprogramme für beliebige SPS dienen - vorausgesetzt, die SPS 
enthält ein hierfür vorbereitetes Echtzeitbetriebssystem und die notwendigen Software- 
module. PROLOG 1, eine Untermenge von PROLOG 2, ist die Fachsprache zur Nota¬ 
tion von AP für eine SPS ursalog 5010 [8.33]. 

In PROLOG 2 wird das Steuerprogramm ausgehend von einer strukturbezogenen 
Darstellung des Steueralgorithmus als eine Folge von Vereinbarungen, Funktions- und 
Bausteinanweisungen notiert. Als strukturbezogene Darstellung (Algorithmusdarstel¬ 
lung mit den Strukturvariablen) eignen sich Strukturgleichungssysteme bzw. Schaltglei¬ 
chungen, Signalflußbild, Programmablaufplan bzw. -graph. Bei Beachtung von Umfor¬ 
mungsregeln kann auch von einem Kontaktnetzwerk ausgegangen werden. Für anspruchs¬ 
volle Probleme besteht auch die Möglichkeit, mittels sog. Betriebssystemaufrufe den 
zeitlichen und priorisierten Lauf von Anwenderprogrammen zu modifizieren. 

Programmstruktur 

Ein in PROLOG 2 notiertes Programm besteht aus Vereinbarungen und Anweisungsfol¬ 
gen. In den Vereinbarungen werden die Art der Prozeßsignaleingabe und -ausgabe und 
Initialwerte für Variablen festgelegt. 

Eine Anweisungsfolge ist die äquivalente Abbildung eines Steueralgorithmus (oder 
eines Teiles davon), bestehend aus einer Folge von Anweisungen für die Ausführung von 
informationsverarbeitenden und programmorganisatorischen Funktionen. Die informa- 
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tionsverarbeitenden Funktionen werden in der SPS durch die Abarbeitung von parame- 
trierbaren Befehlsfolgen (Unterprogramme im Betriebssystem oder direkt Befehlssequen¬ 
zen im Anwendermaschinenprogramm) realisiert. Diese Befehlsfolgen werden unabhän¬ 
gig von der Art ihrer Ausführung Programmodule genannt. Dementsprechend stellen die 
im Quellprogramm zu notierenden Anweisungen Modulaufrufe dar. Der größte Teil der 
programmorganisatorischen Funktionen wird in Komponenten des SPS-Betriebssystems 
(EIEX 1521) realisiert. Die Anweisungen für diese Funktionen werden Betriebssystem¬ 
aufrufe genannt. 

Alle Anweisungen bestehen aus einem Operationsteil und einem Operandenteil. Der 
Operationsteil kennzeichnet die auszuführende Operation. Der Operandenteil enthält die 
für die Ausführung der Operation notwendigen Parameter. Einer Anweisung kann opti¬ 
mal eine Marke in Form einer 3stelligen Dezimalzahl vorangestellt werden. Diese Marke 
dient für Sprungoperationen als Kennzeichen (Parameter im Modulaufruf) der Ansprung¬ 
stelle. 

Zur verständlichen Programmdokumentation sind in allen Programmzeilen Kommen¬ 
tare zugelassen. 

Eine oder auch mehrere Anweisungsfolgen können als Unterprogramme deklariert 
werden. Unterprogramme können von beliebiger Stelle des Programms oder auch anderer 
Programme zur Abarbeitung aufgerufen werden. 


nofierfes Anwender- Übersetzung^ Maschinen- oder 
Programmsystem Objektprogramme, 

(Ouedprogramm- durch nach denen die 

System) Compiler SPS arbeitet 



BUdA2A 

Zusammenhang zwischen Quell- und 
Objektprogrammsystem 


In eine SPS ursalog 5020 können mehrere Programme der beschriebenen Struktur nach 
ihrer Übersetzung eingebunden und zur Abarbeitung gebracht werden. Der Gesamt¬ 
menge von Programmen in ihrer Quellnotation können auch noch Vereinbarungen der 
eingangs genannten Typen vorangestellt werden. Alle Vereinbarungen, die allen Pro¬ 
grammen vorangestellten und die am Anfang eines Programms notierten, sind gleich¬ 
rangig und gelten für alle Programme; sie haben globalen Charakter. Bei der Übersetzung 
der Programme (einschließlich der vorangestellten Vereinbarungen) auf dem Program¬ 
miergerät ursatron 5000 wird ein gemeinsamer Systemblock erstellt. Der Systemblock ist 
ein formatierter Datenbereich, der die globalen Größen (z. B. Adreßvereinbarungen für 
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die Variablenfelder) und Steuerinformationen (z.B. Programm- und Unterprogramm¬ 
verzeichnis, Prozeßperipherie-Tab.) enthält. Er wird der SPS mit den Objektprogrammen 
als Bestandteil des Anwenderprogrammsystems LOGAN 5020 übergeben. Im System¬ 
anlauf der SPS beziehen die Programme zur Systeminitialisierung (Komponenten von 
LOGOS 5020) wesentliche Informationen über die einzubindenden Anwenderprogramme 
aus dem Systemblock. 



BildA2.5 

Beispiel für die Struktur eines 
Programmsystems 


Bild A2.4 verdeutlicht den Zusammenhang zwischen der Quellnotation und der Ma¬ 
schinendarstellung. Mit diesem AP-System ist im Bild A2.5 in vereinfachter Weise die 
Struktur eines SPS-Programmsystems dargestellt. Die Prioritäten sind nur symbolisch 
durch Buchstaben markiert; die Tasks des Betriebssystems werden nur durch drei Tasks 
repräsentiert. In dem Block Dienstprogramme sollen auch alle Sprachmodule und Be¬ 
dienprogramme für Geräte der Prozeßperipherie enthalten sein. 

Konstanten und Bezeichner für Variable 

Konstanten werden zur Parametrierung von Vereinbarungen und Anweisungen verwen¬ 
det. Sie können in unterschiedlicher Darstellung vorgegeben werden: 

Dualkonstanten, z.B. 0B, IB, 101101B, 100011011B 
Oktalkonstanten, z.B. 55Q, 433Q 
Dezimalkonstanten, z.B. 45, 307, —42, —21500 
Hexadezimalkonstanten, z.B. 2DH, IIBH, 0A22FH. 

Negative Dezimalkonstanten werden nur in Arithmetikmodulen verwendet. 
Bezeichner für Variable dienen der Adressierung von Bit-, Byte- und Doppelbyte¬ 
variablen eines Anwendersteuerprogrammsystems. Variable werden als Operanden in den 
Vereinbarungen und Anweisungen verwendet und sind globale Größen, d.h., sie be¬ 
zeichnen in verschiedenen Programmen jeweils ein und dasselbe Datenwort. Folgende 
Variablenbezeichner sind verfügbar: 

Bitvariable 0,1 

Ei Eingangsvariable; mittels Prozeßperipherie erfaßtes Binärsignal 
Aj Ausgangsvariable; mittels Prozeßperipherie auszugebendes Binärsignal 
Mk Merker (Bit); intern erzeugtes Zwischensignal 
ETI Eingang für Zeitmodul / 
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ATI Ausgang von Zeitmodul / 

RTl Rücksetzeingang für Zeitmodul / 

EZm Eingang für Zählmodul m 

AZm Ausgang von Zählmodul m 

RZm Rücksetzeingang für Zählmodul m 

UZm Umschalteingang für Zählmodul m 

AC Akkumulator für Bitlogikmodule (temporärer Merker) 

SM binärer Sondermerker. 


Beispiele 

El Bit 1 von EB0 

E371 Bit 3 von EB46 

A54 Bit 6 von AB6 

ET7 Eingang für Zeitmodul 7 

AZ 12 Ausgang von Zählmodul 12. 

Da die Variablen Ei, Aj und Mk gleichzeitig auch Bits von Bytevariablen EBi*, ABj* und 
MBk* sind, ist unbedingt der Zusammenhang zwischen den Indizes zu berücksichtigen: 

i* = integer [-^] usw. 


Bytevariable 0 bis 255 

EBi* Eingangs variable (jeweils acht Bitvariable E enthaltend) 
ABj* Ausgangsvariable (jeweils acht Bitvariable A enthaltend) 
MBk* Merker (Byte; jeweils acht Bitvariable M enthaltend) 
für intern erzeugte Zwischengrößen 
FZh Fehlerzelle 
ITl Istwert des Zeitmoduls / 

DTl Sollwert für Zeitmodul / (Verzögerungs- oder Impulsdauer) 
PTl zusätzlicher Sollwert für Zeitmodul / vom Typ VIBi 
(Impulspause) 


EDr.0 unteres 
EDr. 1 oberes 
ADs.0 unteres 
ADs. 1 oberes 
MDt.0 unteres 
MDt. 1 oberes 
IZm.0 unteres 
IZm. 1 oberes 


Byte von Doppelbyteeingangsvariable EDr 

•ff 

Byte von Doppelbyteausgangsvariable ADs 

Byte vom Doppelbytemerker MDt 

Byte vom Istwert (zwei Byte) des Zählmoduls m 


GZm.0 unteres 
GZm. 1 oberes 


Byte vom Grenzwert (zwei Byte Sollwert) des Zählmoduls m 


Beispiele 

EB46 Eingangsvariable mit E368 bis E375 
AB6 Ausgangsvariable mit A48 bis A55 

DT7 Sollwert für Zeitmodul 7 
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ED 14 1 I Doppelbyteeingangsvariablen ED 14 

GZ12.0 unteres Byte vom Grenzwert des Zählmoduls 12 

Doppelbytevariable 0 bis {65535} 

EDr Eingangsvariable 
ADs Ausgangsvariable 

MDt Merker (zwei Byte); für intern erzeugte Zwischengrößen 

IZm Istwert (zwei Byte) des Zählmoduls m 

GZm Grenzwert (zwei Byte Sollwert) für Zählmodul m 

Beispiele 

ED 14 Doppelbyteeingangsvariable, bestehend aus den Bytevariablen ED 14.0 und 
ED14.1 

GZ12 Grenzwert für Zählmodul 12, bestehend aus den Bytes GZ12.0 und GZ 12.1. 

Vereinbarungen 

Die folgenden fünf Typen von Vereinbarungen können an beliebiger Stelle des Pro¬ 
grammsystems stehen, in der Regel jedoch allen Programmen vorangestellt oder jeweils 
im Programm direkt nach der Programmeröffnung. Diese Vereinbarungen finden durch 
den Compiler nur Berücksichtigung bei der Erstellung des Systemblocks. 

PEAV Prozeß-Ein-/Ausgabe-Vereinbarung 

zur anwendungsspezifischen Zuordnung von Prozeßsignalen zu Variablen eines 
SPS-internen Abbildspeichers über Eingabegeräte und der umgekehrten Zuord¬ 
nung über Ausgabegeräte 

DEF1 Initialisierungsvereinbarung für Bytevariablen 
z.B. DEFl ABU, 37H, 123Q, 209 

;AB11: = 37H, AB12: = 123Q, AB13: = 209 
DEF2 Initialisierungsvereinbarung für Doppelbytevariablen, 
z.B. DEF2 MD23, 49H, 0B43FH 

;MD23:=49H, MD24:=0B43FH, bzw. MD23.0: = 

;49H, MD23.1: = 0, MD24.0: = 3FH, MD24.1: = 0B4H 
DEF2 ABU, 5337H, 209 

;AB11: = 37H, AB12: = 53H = 123Q, AB13:=209 = 

;0D1H, AB14: = 0 

APRE Vereinbarung zur Einbindung eines prioritätsgesteuerten externen Programms 
(Maschinenkodeprogramm) ins Programmsystem 
IPRE Vereinbarung zur Einbindung eines interruptgesteuerten externen Programms 
(Maschinenkodeprogramm) ins Programmsystem. 

Mit den nachfolgenden Vereinbarungen werden PROLOG-2-Programme eröffnet. Die 
Angaben in den Vereinbarungen bezeichnen das jeweilige Programm und legen Modali¬ 
täten der Abarbeitung fest: 

APRO Vereinbarung eines prioritätsgesteuerten Programms 
IPRO Vereinbarung eines interruptgesteuerten Programms 
UPRO Vereinbarung eines Unterprogramms. 
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Anweisungen 

Anweisungen sind Aufrufe von Programmodulen und Betriebssystemrufe. Programm- 
module sind entweder vom Compiler ins Objektprogramm generierte Prozeduren im 
Sinne von Makros (u.a. alle Logik- und Transportmodule) oder Unterprogramme als 
fester Bestandteil von LOGOS 5020. Die Anweisungen dazu bestehen jeweils aus dem 
Modulbezeichner und einer Folge von Operanden. 

Prozeß-Signalein-j-ausgabe-Module 

PRIN Prozeßsignaleingabe in Regie von EIEX 
PROU Prozeßsignalausgabe in Regie von EIEX 
PRES schnelle Prozeßsignaleingabe 
PRÄS schnelle Prozeßsignalausgabe. 

Transportmodule 

UMBI Wertzuweisung an Bitvariable; bedingt oder unbedingt, 

z.B. UMBI M27,/A13, AT3 

;ÄT3: = M27 bzw. A13: = M27 für AT3 = 1 

;A13 unverändert für AT3 = 0 

UMDl Wertzuweisung an Bytevariable; bedingt oder unbedingt, 

z.B. UMDl 10101010B,AB9,E117 

;AB9: = 0AAH, wenn El 17 = 1, ansonsten unverändert 

UMDl MB27,MB37; MB37: = MB27 

UMUMD2 Wertzuweisung an Doppelbytevariable; 
bedingt oder unbedingt. 

Bitlogik-, Bytelogik-, Zeit- und Zählmodule sind in Tafel A5 dargestellt. Ihre Funktion ist 
äquivalent der bekannter Hardwarebausteine. In der Tabelle entspricht die symbolische 
Darstellung dem jeweiligen Beispiel. 

Vergleichsmodule 

VGLl Vergleich zweier Byteoperanden auf Gleichheit 
VGL2 Vergleich zweier Doppelbyteoperanden auf Gleichheit 
VGRl Vergleich zweier Byteoperanden auf „größer“, 

z.B. VGRl EB16,100,/M13 

;MT3; = 1 für EB16 > 100 

;MT3: = 0 für EB16 ^ 100 

VGR2 Vergleich zweier Doppelbyteoperanden auf „größer“, 
z.B. VGR2 ED13,MD29,A96 

;A96: = 1 für ED13 > MD29 
;A96: = 0 für ED13 ^ MD29 


22 Industrierobotersteuerung 
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Programmorganisationsmodule 

SPRG Sprung zu einer Zielmarke; bedingt oder unbedingt, 
z.B. SPRG 21 ;unbedingter Sprung zur Marke 21 

SPRG 22,E53 ;Sprung zur Marke 22, wenn E53/1 
SPUP Unterprogrammaufruf; bedingt oder unbedingt, 

z.B. SPUP OTTO ;unbedinger Aufruf des Unterprogramms 
;OTTO (UP beginnt mit der Zeile 
;„UPRO OTTO“) 

UEND Endemarkierung für Unterprogramm 

PEND Endemarkierung für prioritätsgesteuertes Programm 

lEND Endemarkierung für interruptgesteuertes Programm. 

Arithmetik module 

Sie verarbeiten vorzeichenbehaftete Rechtskommadualzahlen (Integer-Arithmetik): 

ADDl Addition von Doppelbyteoperanden, 

z.B. ADDl EB14,115,MB15 ;<MB15> := <EB14> +115 

ADD2 Addition von Doppelbyteoperanden 
SUBl Subtraktion von Byteoperanden, 

Z.B.: SUBl MBH, EB9, MB12 ;<MB12> := <MBI1> -<EB9> 

SUB2 Subtraktion von Doppelbyteoperanden 
MUH Multiplikation von Byteoperanden 
MUI2 Multiplikation von Doppelbyteoperanden 
DVIl Division von Byteoperanden 
DVI2 Division von Doppelbyteoperanden 
INKl Inkrementieren einer Bytevariablen 
INK2 Inkrementieren einer Doppelbytevariablen 
DEKl Dekrementieren einer Bytevariablen 
DEK2 Dekrementieren einer Doppelbytevariablen. 

Konvertierungsmodule 

DUDl Dualzahl in 3stellige BCD-Zahl 
DUD2 Dualzahl in Sstellige BCD-Zahl 

z.B. DUD2 MD9,AB8 ;für z.B. MD9 = 7C80H = 31872 

;ergibt die Konvertierung: 

; AB8:/01110010B = 72 

; AB9: = 00011000B = 18 

;AB10: = 00000011B = 03 

DEDl BCD-Zahl in 1-Byte-Dualzahl 
DED2 BCD-Zahl in 2-Byte-Dualzahl. 
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Ergänzungsmodule 

SEMO selbständige Ergänzungsmodule mit Parameterübergabe. 

Unter der Bezeichnung SEMO können weitere Module eingeführt werden, ohne in 
einen abgeschlossenen Compiler für PROLOG 2 eingreifen zu müssen. Die eigentliche 
Modulprozedur wird in die Sammlung von Sprachmoduln des Betriebssystems der SPS 
aufgenommen. 

Betriebssystemrufe 

STRT Start eines Programms zum einmaligen Lauf 
STRZ Start eines Programms zum zeitzyklischen Lauf 
CANC Austragung aus Zeit- und/oder Vorrangorganisation 
PAUS Programmunterbrechung 
GOTO Programmfortsetzung 
DISP Programmverhinderung 
ENAP Programmerlaubnis. 

Programmierbeispiel 

Es sei angenommen, daß der Steueralgorithmus, für den die SPS programmiert werden 
soll, bereits als Logikplan vorliegt. Im Bild A2.6 ist eine Teilschaltung (Auszug vom Ge¬ 
samtlogikplan) dargestellt, für die hier das Steuerprogramm aufgestellt wird. Unter 
Berücksichtigung der byteweisen Zusammenfassung von Eingangs- und Ausgangssigna¬ 
len durch die Prozeß-Signalein-/-ausgabe-Baugruppen werden die Eingänge E und Aus¬ 
gänge A bezeichnet. Alle Zeit- und Zählbausteine werden klassifiziert und äquivalente 


A6 A6 



Bild A 2.6 

Logikplan einer Teilschaltung 


Zeit- und Zählmodule von PROLOG 2 oder notwendigenfalls Ersatzschaltungen zu¬ 
geordnet. Alle Zeitmodule werden von 0 beginnend durchnumeriert, ebenso alle Zähl¬ 
module. Alle Ein- und Ausgänge dieser Module werden mit den typspezifischen Variablen¬ 
bezeichnungen versehen. Jedem durch Bausteine begrenzten Signalpfad einschließlich 
seiner Verzweigungen wird ein Bitmerker zugeordnet, sofern der Signalpfad nicht schon 
durch den Ein- oder Ausgang eines angrenzenden Zeit- oder Zählbausteins bezeichnet ist. 
Ein solcher Bitmerker kann, nachdem seine Weiterverarbeitung in den nachfolgenden 
Bausteinen erfolgt ist, an anderer Stelle erneut verwendet, d.h. also mehrfach verwendet 
werden. Das Ergebnissignal einer logischen Verknüpfung, das nicht über einen Knoten 
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verteilt wird, kann auch mit AC bezeichnet werden, sofern die im Logikplan nachfolgende 
Verknüpfung auch im Quellprogramm in der nächsten Zeile sofort erfolgt. AC repräsen¬ 
tiert den Akkumulator der Einzelbitverarbeitung und kann in der Programmnotation als 
temporärer Bitmerker verwendet werden. 

Die zusätzlichen, für die Programmnotation notwendigen Bezeichnungen sind im Bild 
kursiv eingetragen. Der Rücksetzeingang des anzugverzögernden Zeitglieds TANl Nr. 4 
ist nicht beschältet; er wird auch in der Programmnotation nicht verwendet. Die Anzug¬ 
verzögerungszeit von 3,5 s wird als 35 Dezisekunden angewiesen. Da der Impulsgeber 
IPGl in jedem Zeitbereich nur bis maximal 255 programmiert werden kann, werden die 
geforderten 750 s als 125 Deziminuten angewiesen. Sollte die damit erreichte Auflösung 
nicht ausreichen, müßte nach einer Ersatzschaltung programmiert werden. 

Das im Logikplan enthaltene positiv-flankengetriggerte RS-Flipflop muß durch eine 
Ersatzschaltung programmiert werden. Für PROLOG 2 wurde auf die Übernahme von 
Elementarspeichern in das Modulsortiment verzichtet, da sich dafür die Notation der 
äquivalenten Schaltgleichungen anbietet. Für synchron getaktete Elementarspeicher kann 
die Taktung bei einer SPS-Implementierung der Steuerschaltung meist durch den zykli¬ 
schen Programmlauf ersetzt werden, bzw. sie erübrigt sich. Bei asynchron getakteten 
Elementarspeichern muß das Taktsignal in den Ansteuerbedingungen berücksichtigt wer¬ 
den. Im vorliegenden Fall muß vom Ergebnissignal M2 des Bytevergleichs der 0-1-Über¬ 
gang (positive Signalflanke) erkannt werden. 

Die Anweisungsfolge lautet: 

UMBI M2,M3 ; M3 wird als Zwischenmerker verwendet 

VGLl EB6,MB10,M2 ; M2 wird neu erzeugt 

UNDB /M3,M2,M3 ; M3 = l bei positiver Signalflanke. 

M3 wird nachfolgend mit den Ansteuerbedingungen für den Elementarspeicher kon¬ 
junktiv verknüpft. Die Speichergleichung für das RS-Flipflop mit dominierendem Setzen 
(S-Flipflop) lautet: 

+ = •'(S + ^Q). 

Mit S = E37-M3 und R* = E38'M3 folgt für die Notation der Speichergleichung mittels 
Sprachmodul BOOL: 

BOOL M4 = E37-M3-H/(E38-M3)-M4 

Das Programm für die Schaltung, in der die vorgegebene Teilschaltung enthalten ist, 
soll zeitzyklisch mit 30 ms Zykluszeit abgearbeitet werden und im Rahmen aller SPS- 
Programme mit der Priorität 12 laufen. In der nachfolgenden Programmnotation gibt es 
eine Besonderheit, die nicht im Logikplan enthalten ist. Wenn erstmalig A6= 1, wird der 
Grenzwert für Zählmodul Nr. 5 auf den Wert 350 gesetzt. 

Programm 

0001 APRO 12,3,CS ; 

0002 PEAV 

k PRIN ... ; Aufruf der Eingaben 


Programm der Priorität 12, 
zyklisch mit 30 ms 
Prozeß-Ein-/Ausgabe-Vereinbarung 


/UMBI E7,EZ5 
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1+ 1 UMBI AT4,RZ5 
/+ 2 UMD2 350,GZ5,A6 ; 

/+ 3 ZV02 5,175 ; 

/+ 4 UMBI AZ5,ET4 
/+ 5 TANl 4,35,DS ; 

/+ 6 UNDB E13,AT4,M1 
/+ 7 UNDB /AT4,/E14,AC ; 

/+ 8 ODRB AC,M1,ET5 ; 

/+ 9 ODRB A6,ET5,A26 
/+10IPG1 5,125,DM ; 

/+11 UMBI M2,M3 ; 

/+12VGL1 EB6,MB10,M2 ; 

/+13 UNDB /M3,M2,M3 ; 

/+14 BOOL M4 = E37.M3 + /(E38.M3). 
/+15 UNDB AT5,M4,/M136,/A47 


m PROU ... ; 


GZ5: = 350, wenn A6 = 1 
Vorwärtszähler Nr. 5 

Zeitmodul Nr. 4 

Ergebnis bleibt im Akku, weil 
erster Operand in nächster Zeile 

Zeitmodul Nr. 5 

M3 puffert altes Vergleichsergebnis 
Byte-Vergleich 

M3 = 1 bei positiver Signalflanke 
M4 ; S-Flipflop 


Aufrufe der Ausgaben 


n PEND ; Ende des prioritätsgesteuerten 

Programms 

Das gesamte Programm besteht aus n Vereinbarungen und Anweisungen. Die Teil¬ 
schaltung wird durch 16 Anweisungen bzw. Modulaufrufe realisiert. Die logischen 
Grundverknüpfungen in den Programmzeilen / -f- 6 bis / -h 8 können zusammengefaßt 
als Schaltgleichung programmiert werden. Mit 

BOOL ET5 = E13 • AT4 -h /AT4 • /E14 
reduziert sich die Anweisungsfolge auf 14 Modulaufrufe. 
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